blob: 266766b8d80b61455565cc43779a6e229ed7710d [file] [log] [blame]
Jouni Malinen6039f6d2009-03-19 13:39:21 +02001/*
2 * cfg80211 MLME SAP interface
3 *
4 * Copyright (c) 2009, Jouni Malinen <j@w1.fi>
5 */
6
7#include <linux/kernel.h>
8#include <linux/module.h>
Felix Fietkauc6fb08a2012-03-18 22:58:04 +01009#include <linux/etherdevice.h>
Jouni Malinen6039f6d2009-03-19 13:39:21 +020010#include <linux/netdevice.h>
11#include <linux/nl80211.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090012#include <linux/slab.h>
Johannes Berga9a11622009-07-27 12:01:53 +020013#include <linux/wireless.h>
Jouni Malinen6039f6d2009-03-19 13:39:21 +020014#include <net/cfg80211.h>
Johannes Berga9a11622009-07-27 12:01:53 +020015#include <net/iw_handler.h>
Jouni Malinen6039f6d2009-03-19 13:39:21 +020016#include "core.h"
17#include "nl80211.h"
Hila Gonene35e4d22012-06-27 17:19:42 +030018#include "rdev-ops.h"
19
Jouni Malinen6039f6d2009-03-19 13:39:21 +020020
Johannes Berg6ff57cf2013-05-16 00:55:00 +020021void cfg80211_rx_assoc_resp(struct net_device *dev, struct cfg80211_bss *bss,
Johannes Berg95de8172012-01-20 13:55:25 +010022 const u8 *buf, size_t len)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020023{
Johannes Berg6829c872009-07-02 09:13:27 +020024 struct wireless_dev *wdev = dev->ieee80211_ptr;
25 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +080026 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg6829c872009-07-02 09:13:27 +020027 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
28 u8 *ie = mgmt->u.assoc_resp.variable;
Johannes Berg95de8172012-01-20 13:55:25 +010029 int ieoffs = offsetof(struct ieee80211_mgmt, u.assoc_resp.variable);
Johannes Bergceca7b72013-05-16 00:55:45 +020030 u16 status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code);
Johannes Berg6829c872009-07-02 09:13:27 +020031
Beni Lev4ee3e062012-08-27 12:49:39 +030032 trace_cfg80211_send_rx_assoc(dev, bss);
Johannes Bergcb0b4be2009-07-07 03:56:07 +020033
Johannes Bergf401a6f2009-08-07 14:51:05 +020034 /*
35 * This is a bit of a hack, we don't notify userspace of
36 * a (re-)association reply if we tried to send a reassoc
37 * and got a reject -- we only try again with an assoc
38 * frame instead of reassoc.
39 */
Johannes Bergceca7b72013-05-16 00:55:45 +020040 if (cfg80211_sme_rx_assoc_resp(wdev, status_code)) {
Johannes Bergf1940c52013-06-19 13:21:15 +020041 cfg80211_unhold_bss(bss_from_pub(bss));
Johannes Berg5b112d32013-02-01 01:49:58 +010042 cfg80211_put_bss(wiphy, bss);
Johannes Berg8d61ffa2013-05-10 12:32:47 +020043 return;
Johannes Berg95de8172012-01-20 13:55:25 +010044 }
Johannes Bergf401a6f2009-08-07 14:51:05 +020045
Johannes Bergcb0b4be2009-07-07 03:56:07 +020046 nl80211_send_rx_assoc(rdev, dev, buf, len, GFP_KERNEL);
Johannes Bergceca7b72013-05-16 00:55:45 +020047 /* update current_bss etc., consumes the bss reference */
Johannes Bergdf7fc0f2009-07-29 11:23:49 +020048 __cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, ie, len - ieoffs,
49 status_code,
Johannes Berg95de8172012-01-20 13:55:25 +010050 status_code == WLAN_STATUS_SUCCESS, bss);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020051}
Johannes Berg6ff57cf2013-05-16 00:55:00 +020052EXPORT_SYMBOL(cfg80211_rx_assoc_resp);
Jouni Malinen6039f6d2009-03-19 13:39:21 +020053
Johannes Bergceca7b72013-05-16 00:55:45 +020054static void cfg80211_process_auth(struct wireless_dev *wdev,
55 const u8 *buf, size_t len)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020056{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080057 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg6829c872009-07-02 09:13:27 +020058
Johannes Bergceca7b72013-05-16 00:55:45 +020059 nl80211_send_rx_auth(rdev, wdev->netdev, buf, len, GFP_KERNEL);
60 cfg80211_sme_rx_auth(wdev, buf, len);
Johannes Berg667503dd2009-07-07 03:56:11 +020061}
Jouni Malinen6039f6d2009-03-19 13:39:21 +020062
Johannes Bergceca7b72013-05-16 00:55:45 +020063static void cfg80211_process_deauth(struct wireless_dev *wdev,
64 const u8 *buf, size_t len)
Jouni Malinen6039f6d2009-03-19 13:39:21 +020065{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080066 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Berg6829c872009-07-02 09:13:27 +020067 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
Johannes Berg19957bb2009-07-02 17:20:43 +020068 const u8 *bssid = mgmt->bssid;
Johannes Bergceca7b72013-05-16 00:55:45 +020069 u16 reason_code = le16_to_cpu(mgmt->u.deauth.reason_code);
70 bool from_ap = !ether_addr_equal(mgmt->sa, wdev->netdev->dev_addr);
Johannes Berg6829c872009-07-02 09:13:27 +020071
Johannes Bergceca7b72013-05-16 00:55:45 +020072 nl80211_send_deauth(rdev, wdev->netdev, buf, len, GFP_KERNEL);
Johannes Berg6829c872009-07-02 09:13:27 +020073
Johannes Bergceca7b72013-05-16 00:55:45 +020074 if (!wdev->current_bss ||
75 !ether_addr_equal(wdev->current_bss->pub.bssid, bssid))
Johannes Berg596a07c2009-07-11 00:17:32 +020076 return;
Johannes Berg6829c872009-07-02 09:13:27 +020077
Johannes Bergceca7b72013-05-16 00:55:45 +020078 __cfg80211_disconnected(wdev->netdev, NULL, 0, reason_code, from_ap);
79 cfg80211_sme_deauth(wdev);
80}
Johannes Berg6829c872009-07-02 09:13:27 +020081
Johannes Bergceca7b72013-05-16 00:55:45 +020082static void cfg80211_process_disassoc(struct wireless_dev *wdev,
83 const u8 *buf, size_t len)
84{
Zhao, Gangf26cbf42014-04-21 12:53:03 +080085 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
Johannes Bergceca7b72013-05-16 00:55:45 +020086 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf;
87 const u8 *bssid = mgmt->bssid;
88 u16 reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code);
89 bool from_ap = !ether_addr_equal(mgmt->sa, wdev->netdev->dev_addr);
Johannes Berg19957bb2009-07-02 17:20:43 +020090
Johannes Bergceca7b72013-05-16 00:55:45 +020091 nl80211_send_disassoc(rdev, wdev->netdev, buf, len, GFP_KERNEL);
92
93 if (WARN_ON(!wdev->current_bss ||
94 !ether_addr_equal(wdev->current_bss->pub.bssid, bssid)))
95 return;
96
97 __cfg80211_disconnected(wdev->netdev, NULL, 0, reason_code, from_ap);
98 cfg80211_sme_disassoc(wdev);
Johannes Berg667503dd2009-07-07 03:56:11 +020099}
Jouni Malinena3b8b052009-03-27 21:59:49 +0200100
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200101void cfg80211_rx_mlme_mgmt(struct net_device *dev, const u8 *buf, size_t len)
102{
103 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200104 struct ieee80211_mgmt *mgmt = (void *)buf;
105
106 ASSERT_WDEV_LOCK(wdev);
107
108 trace_cfg80211_rx_mlme_mgmt(dev, buf, len);
109
110 if (WARN_ON(len < 2))
111 return;
112
Johannes Bergceca7b72013-05-16 00:55:45 +0200113 if (ieee80211_is_auth(mgmt->frame_control))
114 cfg80211_process_auth(wdev, buf, len);
115 else if (ieee80211_is_deauth(mgmt->frame_control))
116 cfg80211_process_deauth(wdev, buf, len);
117 else if (ieee80211_is_disassoc(mgmt->frame_control))
118 cfg80211_process_disassoc(wdev, buf, len);
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200119}
120EXPORT_SYMBOL(cfg80211_rx_mlme_mgmt);
121
122void cfg80211_auth_timeout(struct net_device *dev, const u8 *addr)
Johannes Berga58ce432009-11-19 12:45:42 +0100123{
124 struct wireless_dev *wdev = dev->ieee80211_ptr;
125 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800126 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berga58ce432009-11-19 12:45:42 +0100127
Beni Lev4ee3e062012-08-27 12:49:39 +0300128 trace_cfg80211_send_auth_timeout(dev, addr);
Johannes Berga58ce432009-11-19 12:45:42 +0100129
130 nl80211_send_auth_timeout(rdev, dev, addr, GFP_KERNEL);
Johannes Bergceca7b72013-05-16 00:55:45 +0200131 cfg80211_sme_auth_timeout(wdev);
Jouni Malinen1965c852009-04-22 21:38:25 +0300132}
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200133EXPORT_SYMBOL(cfg80211_auth_timeout);
Jouni Malinen1965c852009-04-22 21:38:25 +0300134
Johannes Berg959867f2013-06-19 13:05:42 +0200135void cfg80211_assoc_timeout(struct net_device *dev, struct cfg80211_bss *bss)
Jouni Malinen1965c852009-04-22 21:38:25 +0300136{
Johannes Berg6829c872009-07-02 09:13:27 +0200137 struct wireless_dev *wdev = dev->ieee80211_ptr;
138 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800139 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg19957bb2009-07-02 17:20:43 +0200140
Johannes Berg959867f2013-06-19 13:05:42 +0200141 trace_cfg80211_send_assoc_timeout(dev, bss->bssid);
Johannes Bergcb0b4be2009-07-07 03:56:07 +0200142
Johannes Berg959867f2013-06-19 13:05:42 +0200143 nl80211_send_assoc_timeout(rdev, dev, bss->bssid, GFP_KERNEL);
Johannes Bergceca7b72013-05-16 00:55:45 +0200144 cfg80211_sme_assoc_timeout(wdev);
Johannes Berg959867f2013-06-19 13:05:42 +0200145
Johannes Bergf1940c52013-06-19 13:21:15 +0200146 cfg80211_unhold_bss(bss_from_pub(bss));
Johannes Berg959867f2013-06-19 13:05:42 +0200147 cfg80211_put_bss(wiphy, bss);
Jouni Malinen1965c852009-04-22 21:38:25 +0300148}
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200149EXPORT_SYMBOL(cfg80211_assoc_timeout);
150
151void cfg80211_tx_mlme_mgmt(struct net_device *dev, const u8 *buf, size_t len)
152{
153 struct wireless_dev *wdev = dev->ieee80211_ptr;
154 struct ieee80211_mgmt *mgmt = (void *)buf;
155
156 ASSERT_WDEV_LOCK(wdev);
157
158 trace_cfg80211_tx_mlme_mgmt(dev, buf, len);
159
160 if (WARN_ON(len < 2))
161 return;
162
163 if (ieee80211_is_deauth(mgmt->frame_control))
Johannes Bergceca7b72013-05-16 00:55:45 +0200164 cfg80211_process_deauth(wdev, buf, len);
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200165 else
Johannes Bergceca7b72013-05-16 00:55:45 +0200166 cfg80211_process_disassoc(wdev, buf, len);
Johannes Berg6ff57cf2013-05-16 00:55:00 +0200167}
168EXPORT_SYMBOL(cfg80211_tx_mlme_mgmt);
Jouni Malinen1965c852009-04-22 21:38:25 +0300169
Jouni Malinena3b8b052009-03-27 21:59:49 +0200170void cfg80211_michael_mic_failure(struct net_device *dev, const u8 *addr,
171 enum nl80211_key_type key_type, int key_id,
Johannes Berge6d6e342009-07-01 21:26:47 +0200172 const u8 *tsc, gfp_t gfp)
Jouni Malinena3b8b052009-03-27 21:59:49 +0200173{
174 struct wiphy *wiphy = dev->ieee80211_ptr->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800175 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg3d23e342009-09-29 23:27:28 +0200176#ifdef CONFIG_CFG80211_WEXT
Johannes Bergf58d4ed2009-06-19 02:45:21 +0200177 union iwreq_data wrqu;
Johannes Berge6d6e342009-07-01 21:26:47 +0200178 char *buf = kmalloc(128, gfp);
Johannes Bergf58d4ed2009-06-19 02:45:21 +0200179
180 if (buf) {
181 sprintf(buf, "MLME-MICHAELMICFAILURE.indication("
182 "keyid=%d %scast addr=%pM)", key_id,
183 key_type == NL80211_KEYTYPE_GROUP ? "broad" : "uni",
184 addr);
185 memset(&wrqu, 0, sizeof(wrqu));
186 wrqu.data.length = strlen(buf);
187 wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf);
188 kfree(buf);
189 }
190#endif
191
Beni Lev4ee3e062012-08-27 12:49:39 +0300192 trace_cfg80211_michael_mic_failure(dev, addr, key_type, key_id, tsc);
Johannes Berge6d6e342009-07-01 21:26:47 +0200193 nl80211_michael_mic_failure(rdev, dev, addr, key_type, key_id, tsc, gfp);
Jouni Malinena3b8b052009-03-27 21:59:49 +0200194}
195EXPORT_SYMBOL(cfg80211_michael_mic_failure);
Johannes Berg19957bb2009-07-02 17:20:43 +0200196
197/* some MLME handling for userspace SME */
Johannes Berg91bf9b22013-05-15 17:44:01 +0200198int cfg80211_mlme_auth(struct cfg80211_registered_device *rdev,
199 struct net_device *dev,
200 struct ieee80211_channel *chan,
201 enum nl80211_auth_type auth_type,
202 const u8 *bssid,
203 const u8 *ssid, int ssid_len,
204 const u8 *ie, int ie_len,
205 const u8 *key, int key_len, int key_idx,
206 const u8 *sae_data, int sae_data_len)
Johannes Berg19957bb2009-07-02 17:20:43 +0200207{
208 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg7ade7032013-05-13 11:37:30 +0200209 struct cfg80211_auth_request req = {
210 .ie = ie,
211 .ie_len = ie_len,
212 .sae_data = sae_data,
213 .sae_data_len = sae_data_len,
214 .auth_type = auth_type,
215 .key = key,
216 .key_len = key_len,
217 .key_idx = key_idx,
218 };
Johannes Berg95de8172012-01-20 13:55:25 +0100219 int err;
Johannes Berg19957bb2009-07-02 17:20:43 +0200220
Johannes Berg667503dd2009-07-07 03:56:11 +0200221 ASSERT_WDEV_LOCK(wdev);
222
Johannes Bergfffd0932009-07-08 14:22:54 +0200223 if (auth_type == NL80211_AUTHTYPE_SHARED_KEY)
224 if (!key || !key_len || key_idx < 0 || key_idx > 4)
225 return -EINVAL;
226
Johannes Berg0a9b5e12009-07-02 18:26:18 +0200227 if (wdev->current_bss &&
Joe Perchesac422d32012-05-08 18:56:55 +0000228 ether_addr_equal(bssid, wdev->current_bss->pub.bssid))
Johannes Berg0a9b5e12009-07-02 18:26:18 +0200229 return -EALREADY;
230
Johannes Berg19957bb2009-07-02 17:20:43 +0200231 req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
232 WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
233 if (!req.bss)
234 return -ENOENT;
235
Hila Gonene35e4d22012-06-27 17:19:42 +0300236 err = rdev_auth(rdev, dev, &req);
Johannes Berg19957bb2009-07-02 17:20:43 +0200237
Johannes Berg5b112d32013-02-01 01:49:58 +0100238 cfg80211_put_bss(&rdev->wiphy, req.bss);
Johannes Berg19957bb2009-07-02 17:20:43 +0200239 return err;
240}
241
Ben Greear7e7c8922011-11-18 11:31:59 -0800242/* Do a logical ht_capa &= ht_capa_mask. */
243void cfg80211_oper_and_ht_capa(struct ieee80211_ht_cap *ht_capa,
244 const struct ieee80211_ht_cap *ht_capa_mask)
245{
246 int i;
247 u8 *p1, *p2;
248 if (!ht_capa_mask) {
249 memset(ht_capa, 0, sizeof(*ht_capa));
250 return;
251 }
252
253 p1 = (u8*)(ht_capa);
254 p2 = (u8*)(ht_capa_mask);
255 for (i = 0; i<sizeof(*ht_capa); i++)
256 p1[i] &= p2[i];
257}
258
Johannes Bergee2aca32013-02-21 17:36:01 +0100259/* Do a logical ht_capa &= ht_capa_mask. */
260void cfg80211_oper_and_vht_capa(struct ieee80211_vht_cap *vht_capa,
261 const struct ieee80211_vht_cap *vht_capa_mask)
262{
263 int i;
264 u8 *p1, *p2;
265 if (!vht_capa_mask) {
266 memset(vht_capa, 0, sizeof(*vht_capa));
267 return;
268 }
269
270 p1 = (u8*)(vht_capa);
271 p2 = (u8*)(vht_capa_mask);
272 for (i = 0; i < sizeof(*vht_capa); i++)
273 p1[i] &= p2[i];
274}
275
Johannes Berg91bf9b22013-05-15 17:44:01 +0200276int cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev,
277 struct net_device *dev,
278 struct ieee80211_channel *chan,
279 const u8 *bssid,
280 const u8 *ssid, int ssid_len,
281 struct cfg80211_assoc_request *req)
Johannes Berg19957bb2009-07-02 17:20:43 +0200282{
283 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg95de8172012-01-20 13:55:25 +0100284 int err;
Johannes Berg19957bb2009-07-02 17:20:43 +0200285
Johannes Berg667503dd2009-07-07 03:56:11 +0200286 ASSERT_WDEV_LOCK(wdev);
287
Johannes Bergceca7b72013-05-16 00:55:45 +0200288 if (wdev->current_bss &&
289 (!req->prev_bssid || !ether_addr_equal(wdev->current_bss->pub.bssid,
290 req->prev_bssid)))
Johannes Berg19957bb2009-07-02 17:20:43 +0200291 return -EALREADY;
292
Johannes Bergf62fab72013-02-21 20:09:09 +0100293 cfg80211_oper_and_ht_capa(&req->ht_capa_mask,
Ben Greear7e7c8922011-11-18 11:31:59 -0800294 rdev->wiphy.ht_capa_mod_mask);
Johannes Bergf62fab72013-02-21 20:09:09 +0100295 cfg80211_oper_and_vht_capa(&req->vht_capa_mask,
Johannes Bergee2aca32013-02-21 17:36:01 +0100296 rdev->wiphy.vht_capa_mod_mask);
Ben Greear7e7c8922011-11-18 11:31:59 -0800297
Johannes Bergf62fab72013-02-21 20:09:09 +0100298 req->bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len,
299 WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
Johannes Bergceca7b72013-05-16 00:55:45 +0200300 if (!req->bss)
Johannes Berg19957bb2009-07-02 17:20:43 +0200301 return -ENOENT;
302
Johannes Bergf62fab72013-02-21 20:09:09 +0100303 err = rdev_assoc(rdev, dev, req);
Johannes Bergf1940c52013-06-19 13:21:15 +0200304 if (!err)
305 cfg80211_hold_bss(bss_from_pub(req->bss));
Luciano Coelho73de86a2014-02-13 11:31:59 +0200306 else
Johannes Bergf62fab72013-02-21 20:09:09 +0100307 cfg80211_put_bss(&rdev->wiphy, req->bss);
Johannes Berg95de8172012-01-20 13:55:25 +0100308
Johannes Berg19957bb2009-07-02 17:20:43 +0200309 return err;
310}
311
Johannes Berg91bf9b22013-05-15 17:44:01 +0200312int cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev,
313 struct net_device *dev, const u8 *bssid,
314 const u8 *ie, int ie_len, u16 reason,
315 bool local_state_change)
Johannes Berg19957bb2009-07-02 17:20:43 +0200316{
317 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg95de8172012-01-20 13:55:25 +0100318 struct cfg80211_deauth_request req = {
319 .bssid = bssid,
320 .reason_code = reason,
321 .ie = ie,
322 .ie_len = ie_len,
Stanislaw Gruszka68632552012-10-15 14:52:41 +0200323 .local_state_change = local_state_change,
Johannes Berg95de8172012-01-20 13:55:25 +0100324 };
Johannes Berg19957bb2009-07-02 17:20:43 +0200325
Johannes Berg667503dd2009-07-07 03:56:11 +0200326 ASSERT_WDEV_LOCK(wdev);
327
Johannes Bergceca7b72013-05-16 00:55:45 +0200328 if (local_state_change &&
329 (!wdev->current_bss ||
330 !ether_addr_equal(wdev->current_bss->pub.bssid, bssid)))
Johannes Berg95de8172012-01-20 13:55:25 +0100331 return 0;
Johannes Berg19957bb2009-07-02 17:20:43 +0200332
Hila Gonene35e4d22012-06-27 17:19:42 +0300333 return rdev_deauth(rdev, dev, &req);
Johannes Berg19957bb2009-07-02 17:20:43 +0200334}
335
Johannes Berg91bf9b22013-05-15 17:44:01 +0200336int cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev,
337 struct net_device *dev, const u8 *bssid,
338 const u8 *ie, int ie_len, u16 reason,
339 bool local_state_change)
Johannes Berg19957bb2009-07-02 17:20:43 +0200340{
341 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg7ade7032013-05-13 11:37:30 +0200342 struct cfg80211_disassoc_request req = {
343 .reason_code = reason,
344 .local_state_change = local_state_change,
345 .ie = ie,
346 .ie_len = ie_len,
347 };
Johannes Bergceca7b72013-05-16 00:55:45 +0200348 int err;
Johannes Berg19957bb2009-07-02 17:20:43 +0200349
Johannes Berg667503dd2009-07-07 03:56:11 +0200350 ASSERT_WDEV_LOCK(wdev);
351
Johannes Bergceca7b72013-05-16 00:55:45 +0200352 if (!wdev->current_bss)
Johannes Bergf9d6b402009-07-27 10:22:28 +0200353 return -ENOTCONN;
354
Joe Perchesac422d32012-05-08 18:56:55 +0000355 if (ether_addr_equal(wdev->current_bss->pub.bssid, bssid))
Johannes Berg19957bb2009-07-02 17:20:43 +0200356 req.bss = &wdev->current_bss->pub;
357 else
358 return -ENOTCONN;
359
Johannes Bergceca7b72013-05-16 00:55:45 +0200360 err = rdev_disassoc(rdev, dev, &req);
361 if (err)
362 return err;
363
364 /* driver should have reported the disassoc */
365 WARN_ON(wdev->current_bss);
366 return 0;
Johannes Berg667503dd2009-07-07 03:56:11 +0200367}
368
Johannes Berg19957bb2009-07-02 17:20:43 +0200369void cfg80211_mlme_down(struct cfg80211_registered_device *rdev,
370 struct net_device *dev)
371{
372 struct wireless_dev *wdev = dev->ieee80211_ptr;
Johannes Berg95de8172012-01-20 13:55:25 +0100373 u8 bssid[ETH_ALEN];
Johannes Berg19957bb2009-07-02 17:20:43 +0200374
Johannes Berg667503dd2009-07-07 03:56:11 +0200375 ASSERT_WDEV_LOCK(wdev);
376
Johannes Berg19957bb2009-07-02 17:20:43 +0200377 if (!rdev->ops->deauth)
378 return;
379
Johannes Berg95de8172012-01-20 13:55:25 +0100380 if (!wdev->current_bss)
381 return;
Johannes Berg19957bb2009-07-02 17:20:43 +0200382
Johannes Berg95de8172012-01-20 13:55:25 +0100383 memcpy(bssid, wdev->current_bss->pub.bssid, ETH_ALEN);
Johannes Bergceca7b72013-05-16 00:55:45 +0200384 cfg80211_mlme_deauth(rdev, dev, bssid, NULL, 0,
385 WLAN_REASON_DEAUTH_LEAVING, false);
Johannes Berg19957bb2009-07-02 17:20:43 +0200386}
Jouni Malinen9588bbd2009-12-23 13:15:41 +0100387
Johannes Berg2e161f72010-08-12 15:38:38 +0200388struct cfg80211_mgmt_registration {
Jouni Malinen026331c2010-02-15 12:53:10 +0200389 struct list_head list;
390
Eric W. Biederman15e47302012-09-07 20:12:54 +0000391 u32 nlportid;
Jouni Malinen026331c2010-02-15 12:53:10 +0200392
393 int match_len;
394
Johannes Berg2e161f72010-08-12 15:38:38 +0200395 __le16 frame_type;
396
Jouni Malinen026331c2010-02-15 12:53:10 +0200397 u8 match[];
398};
399
Eric W. Biederman15e47302012-09-07 20:12:54 +0000400int cfg80211_mlme_register_mgmt(struct wireless_dev *wdev, u32 snd_portid,
Johannes Berg2e161f72010-08-12 15:38:38 +0200401 u16 frame_type, const u8 *match_data,
402 int match_len)
Jouni Malinen026331c2010-02-15 12:53:10 +0200403{
Johannes Berg271733c2010-10-13 12:06:23 +0200404 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800405 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg2e161f72010-08-12 15:38:38 +0200406 struct cfg80211_mgmt_registration *reg, *nreg;
Jouni Malinen026331c2010-02-15 12:53:10 +0200407 int err = 0;
Johannes Berg2e161f72010-08-12 15:38:38 +0200408 u16 mgmt_type;
409
410 if (!wdev->wiphy->mgmt_stypes)
411 return -EOPNOTSUPP;
412
413 if ((frame_type & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_MGMT)
414 return -EINVAL;
415
416 if (frame_type & ~(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE))
417 return -EINVAL;
418
419 mgmt_type = (frame_type & IEEE80211_FCTL_STYPE) >> 4;
420 if (!(wdev->wiphy->mgmt_stypes[wdev->iftype].rx & BIT(mgmt_type)))
421 return -EINVAL;
Jouni Malinen026331c2010-02-15 12:53:10 +0200422
423 nreg = kzalloc(sizeof(*reg) + match_len, GFP_KERNEL);
424 if (!nreg)
425 return -ENOMEM;
426
Johannes Berg2e161f72010-08-12 15:38:38 +0200427 spin_lock_bh(&wdev->mgmt_registrations_lock);
Jouni Malinen026331c2010-02-15 12:53:10 +0200428
Johannes Berg2e161f72010-08-12 15:38:38 +0200429 list_for_each_entry(reg, &wdev->mgmt_registrations, list) {
Jouni Malinen026331c2010-02-15 12:53:10 +0200430 int mlen = min(match_len, reg->match_len);
431
Johannes Berg2e161f72010-08-12 15:38:38 +0200432 if (frame_type != le16_to_cpu(reg->frame_type))
433 continue;
434
Jouni Malinen026331c2010-02-15 12:53:10 +0200435 if (memcmp(reg->match, match_data, mlen) == 0) {
436 err = -EALREADY;
437 break;
438 }
439 }
440
441 if (err) {
442 kfree(nreg);
443 goto out;
444 }
445
446 memcpy(nreg->match, match_data, match_len);
447 nreg->match_len = match_len;
Eric W. Biederman15e47302012-09-07 20:12:54 +0000448 nreg->nlportid = snd_portid;
Johannes Berg2e161f72010-08-12 15:38:38 +0200449 nreg->frame_type = cpu_to_le16(frame_type);
450 list_add(&nreg->list, &wdev->mgmt_registrations);
Jouni Malinen026331c2010-02-15 12:53:10 +0200451
Johannes Berg271733c2010-10-13 12:06:23 +0200452 if (rdev->ops->mgmt_frame_register)
Hila Gonene35e4d22012-06-27 17:19:42 +0300453 rdev_mgmt_frame_register(rdev, wdev, frame_type, true);
Johannes Berg271733c2010-10-13 12:06:23 +0200454
Jouni Malinen026331c2010-02-15 12:53:10 +0200455 out:
Johannes Berg2e161f72010-08-12 15:38:38 +0200456 spin_unlock_bh(&wdev->mgmt_registrations_lock);
Johannes Berg271733c2010-10-13 12:06:23 +0200457
Jouni Malinen026331c2010-02-15 12:53:10 +0200458 return err;
459}
460
Eric W. Biederman15e47302012-09-07 20:12:54 +0000461void cfg80211_mlme_unregister_socket(struct wireless_dev *wdev, u32 nlportid)
Jouni Malinen026331c2010-02-15 12:53:10 +0200462{
Johannes Berg271733c2010-10-13 12:06:23 +0200463 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800464 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg2e161f72010-08-12 15:38:38 +0200465 struct cfg80211_mgmt_registration *reg, *tmp;
Jouni Malinen026331c2010-02-15 12:53:10 +0200466
Johannes Berg2e161f72010-08-12 15:38:38 +0200467 spin_lock_bh(&wdev->mgmt_registrations_lock);
Jouni Malinen026331c2010-02-15 12:53:10 +0200468
Johannes Berg2e161f72010-08-12 15:38:38 +0200469 list_for_each_entry_safe(reg, tmp, &wdev->mgmt_registrations, list) {
Eric W. Biederman15e47302012-09-07 20:12:54 +0000470 if (reg->nlportid != nlportid)
Johannes Berg271733c2010-10-13 12:06:23 +0200471 continue;
472
473 if (rdev->ops->mgmt_frame_register) {
474 u16 frame_type = le16_to_cpu(reg->frame_type);
475
Hila Gonene35e4d22012-06-27 17:19:42 +0300476 rdev_mgmt_frame_register(rdev, wdev,
477 frame_type, false);
Jouni Malinen026331c2010-02-15 12:53:10 +0200478 }
Johannes Berg271733c2010-10-13 12:06:23 +0200479
480 list_del(&reg->list);
481 kfree(reg);
Jouni Malinen026331c2010-02-15 12:53:10 +0200482 }
483
Johannes Berg2e161f72010-08-12 15:38:38 +0200484 spin_unlock_bh(&wdev->mgmt_registrations_lock);
Johannes Berg28946da2011-11-04 11:18:12 +0100485
Arend van Spriel5de17982013-04-18 15:49:00 +0200486 if (nlportid && rdev->crit_proto_nlportid == nlportid) {
487 rdev->crit_proto_nlportid = 0;
488 rdev_crit_proto_stop(rdev, wdev);
489 }
490
Eric W. Biederman15e47302012-09-07 20:12:54 +0000491 if (nlportid == wdev->ap_unexpected_nlportid)
492 wdev->ap_unexpected_nlportid = 0;
Jouni Malinen026331c2010-02-15 12:53:10 +0200493}
494
Johannes Berg2e161f72010-08-12 15:38:38 +0200495void cfg80211_mlme_purge_registrations(struct wireless_dev *wdev)
Jouni Malinen026331c2010-02-15 12:53:10 +0200496{
Johannes Berg2e161f72010-08-12 15:38:38 +0200497 struct cfg80211_mgmt_registration *reg, *tmp;
Jouni Malinen026331c2010-02-15 12:53:10 +0200498
Johannes Berg2e161f72010-08-12 15:38:38 +0200499 spin_lock_bh(&wdev->mgmt_registrations_lock);
Jouni Malinen026331c2010-02-15 12:53:10 +0200500
Johannes Berg2e161f72010-08-12 15:38:38 +0200501 list_for_each_entry_safe(reg, tmp, &wdev->mgmt_registrations, list) {
Jouni Malinen026331c2010-02-15 12:53:10 +0200502 list_del(&reg->list);
503 kfree(reg);
504 }
505
Johannes Berg2e161f72010-08-12 15:38:38 +0200506 spin_unlock_bh(&wdev->mgmt_registrations_lock);
Jouni Malinen026331c2010-02-15 12:53:10 +0200507}
508
Johannes Berg2e161f72010-08-12 15:38:38 +0200509int cfg80211_mlme_mgmt_tx(struct cfg80211_registered_device *rdev,
Johannes Berg71bbc992012-06-15 15:30:18 +0200510 struct wireless_dev *wdev,
Andrei Otcheretianskib176e622013-11-18 19:06:49 +0200511 struct cfg80211_mgmt_tx_params *params, u64 *cookie)
Jouni Malinen026331c2010-02-15 12:53:10 +0200512{
Jouni Malinen026331c2010-02-15 12:53:10 +0200513 const struct ieee80211_mgmt *mgmt;
Johannes Berg2e161f72010-08-12 15:38:38 +0200514 u16 stype;
Jouni Malinen026331c2010-02-15 12:53:10 +0200515
Johannes Berg2e161f72010-08-12 15:38:38 +0200516 if (!wdev->wiphy->mgmt_stypes)
Jouni Malinen026331c2010-02-15 12:53:10 +0200517 return -EOPNOTSUPP;
Johannes Berg2e161f72010-08-12 15:38:38 +0200518
519 if (!rdev->ops->mgmt_tx)
520 return -EOPNOTSUPP;
521
Andrei Otcheretianskib176e622013-11-18 19:06:49 +0200522 if (params->len < 24 + 1)
Jouni Malinen026331c2010-02-15 12:53:10 +0200523 return -EINVAL;
524
Andrei Otcheretianskib176e622013-11-18 19:06:49 +0200525 mgmt = (const struct ieee80211_mgmt *)params->buf;
Johannes Berg2e161f72010-08-12 15:38:38 +0200526
527 if (!ieee80211_is_mgmt(mgmt->frame_control))
Jouni Malinen026331c2010-02-15 12:53:10 +0200528 return -EINVAL;
Johannes Berg2e161f72010-08-12 15:38:38 +0200529
530 stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE;
531 if (!(wdev->wiphy->mgmt_stypes[wdev->iftype].tx & BIT(stype >> 4)))
532 return -EINVAL;
533
534 if (ieee80211_is_action(mgmt->frame_control) &&
535 mgmt->u.action.category != WLAN_CATEGORY_PUBLIC) {
Johannes Berg663fcaf2010-09-30 21:06:09 +0200536 int err = 0;
537
Johannes Bergfe100ac2010-08-09 15:52:03 +0200538 wdev_lock(wdev);
539
Johannes Berg663fcaf2010-09-30 21:06:09 +0200540 switch (wdev->iftype) {
541 case NL80211_IFTYPE_ADHOC:
542 case NL80211_IFTYPE_STATION:
543 case NL80211_IFTYPE_P2P_CLIENT:
544 if (!wdev->current_bss) {
545 err = -ENOTCONN;
546 break;
547 }
Johannes Bergfe100ac2010-08-09 15:52:03 +0200548
Joe Perchesac422d32012-05-08 18:56:55 +0000549 if (!ether_addr_equal(wdev->current_bss->pub.bssid,
550 mgmt->bssid)) {
Johannes Berg663fcaf2010-09-30 21:06:09 +0200551 err = -ENOTCONN;
552 break;
553 }
554
555 /*
556 * check for IBSS DA must be done by driver as
557 * cfg80211 doesn't track the stations
558 */
559 if (wdev->iftype == NL80211_IFTYPE_ADHOC)
560 break;
561
562 /* for station, check that DA is the AP */
Joe Perchesac422d32012-05-08 18:56:55 +0000563 if (!ether_addr_equal(wdev->current_bss->pub.bssid,
564 mgmt->da)) {
Johannes Berg663fcaf2010-09-30 21:06:09 +0200565 err = -ENOTCONN;
566 break;
567 }
568 break;
569 case NL80211_IFTYPE_AP:
570 case NL80211_IFTYPE_P2P_GO:
571 case NL80211_IFTYPE_AP_VLAN:
Johannes Berg98104fde2012-06-16 00:19:54 +0200572 if (!ether_addr_equal(mgmt->bssid, wdev_address(wdev)))
Johannes Berg663fcaf2010-09-30 21:06:09 +0200573 err = -EINVAL;
574 break;
Javier Cardona0778a6a2011-05-03 16:57:08 -0700575 case NL80211_IFTYPE_MESH_POINT:
Joe Perchesac422d32012-05-08 18:56:55 +0000576 if (!ether_addr_equal(mgmt->sa, mgmt->bssid)) {
Javier Cardona0778a6a2011-05-03 16:57:08 -0700577 err = -EINVAL;
578 break;
579 }
580 /*
581 * check for mesh DA must be done by driver as
582 * cfg80211 doesn't track the stations
583 */
584 break;
Johannes Berg98104fde2012-06-16 00:19:54 +0200585 case NL80211_IFTYPE_P2P_DEVICE:
586 /*
587 * fall through, P2P device only supports
588 * public action frames
589 */
Johannes Berg663fcaf2010-09-30 21:06:09 +0200590 default:
591 err = -EOPNOTSUPP;
592 break;
593 }
Johannes Bergfe100ac2010-08-09 15:52:03 +0200594 wdev_unlock(wdev);
Johannes Berg663fcaf2010-09-30 21:06:09 +0200595
596 if (err)
597 return err;
Jouni Malinen026331c2010-02-15 12:53:10 +0200598 }
599
Johannes Berg98104fde2012-06-16 00:19:54 +0200600 if (!ether_addr_equal(mgmt->sa, wdev_address(wdev)))
Jouni Malinen026331c2010-02-15 12:53:10 +0200601 return -EINVAL;
602
603 /* Transmit the Action frame as requested by user space */
Andrei Otcheretianskib176e622013-11-18 19:06:49 +0200604 return rdev_mgmt_tx(rdev, wdev, params, cookie);
Jouni Malinen026331c2010-02-15 12:53:10 +0200605}
606
Johannes Berg71bbc992012-06-15 15:30:18 +0200607bool cfg80211_rx_mgmt(struct wireless_dev *wdev, int freq, int sig_mbm,
Vladimir Kondratiev19504cf2013-08-15 14:51:28 +0300608 const u8 *buf, size_t len, u32 flags, gfp_t gfp)
Jouni Malinen026331c2010-02-15 12:53:10 +0200609{
Jouni Malinen026331c2010-02-15 12:53:10 +0200610 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800611 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Johannes Berg2e161f72010-08-12 15:38:38 +0200612 struct cfg80211_mgmt_registration *reg;
613 const struct ieee80211_txrx_stypes *stypes =
614 &wiphy->mgmt_stypes[wdev->iftype];
615 struct ieee80211_mgmt *mgmt = (void *)buf;
616 const u8 *data;
617 int data_len;
Jouni Malinen026331c2010-02-15 12:53:10 +0200618 bool result = false;
Johannes Berg2e161f72010-08-12 15:38:38 +0200619 __le16 ftype = mgmt->frame_control &
620 cpu_to_le16(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE);
621 u16 stype;
Jouni Malinen026331c2010-02-15 12:53:10 +0200622
Beni Lev4ee3e062012-08-27 12:49:39 +0300623 trace_cfg80211_rx_mgmt(wdev, freq, sig_mbm);
Johannes Berg2e161f72010-08-12 15:38:38 +0200624 stype = (le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE) >> 4;
Jouni Malinen026331c2010-02-15 12:53:10 +0200625
Beni Lev4ee3e062012-08-27 12:49:39 +0300626 if (!(stypes->rx & BIT(stype))) {
627 trace_cfg80211_return_bool(false);
Johannes Berg2e161f72010-08-12 15:38:38 +0200628 return false;
Beni Lev4ee3e062012-08-27 12:49:39 +0300629 }
Jouni Malinen026331c2010-02-15 12:53:10 +0200630
Johannes Berg2e161f72010-08-12 15:38:38 +0200631 data = buf + ieee80211_hdrlen(mgmt->frame_control);
632 data_len = len - ieee80211_hdrlen(mgmt->frame_control);
Jouni Malinen026331c2010-02-15 12:53:10 +0200633
Johannes Berg2e161f72010-08-12 15:38:38 +0200634 spin_lock_bh(&wdev->mgmt_registrations_lock);
635
636 list_for_each_entry(reg, &wdev->mgmt_registrations, list) {
637 if (reg->frame_type != ftype)
Jouni Malinen026331c2010-02-15 12:53:10 +0200638 continue;
639
Johannes Berg2e161f72010-08-12 15:38:38 +0200640 if (reg->match_len > data_len)
641 continue;
642
643 if (memcmp(reg->match, data, reg->match_len))
Jouni Malinen026331c2010-02-15 12:53:10 +0200644 continue;
645
646 /* found match! */
647
648 /* Indicate the received Action frame to user space */
Eric W. Biederman15e47302012-09-07 20:12:54 +0000649 if (nl80211_send_mgmt(rdev, wdev, reg->nlportid,
Johannes Berg804483e2012-03-05 22:18:41 +0100650 freq, sig_mbm,
Vladimir Kondratiev19504cf2013-08-15 14:51:28 +0300651 buf, len, flags, gfp))
Jouni Malinen026331c2010-02-15 12:53:10 +0200652 continue;
653
654 result = true;
655 break;
656 }
657
Johannes Berg2e161f72010-08-12 15:38:38 +0200658 spin_unlock_bh(&wdev->mgmt_registrations_lock);
Jouni Malinen026331c2010-02-15 12:53:10 +0200659
Beni Lev4ee3e062012-08-27 12:49:39 +0300660 trace_cfg80211_return_bool(result);
Jouni Malinen026331c2010-02-15 12:53:10 +0200661 return result;
662}
Johannes Berg2e161f72010-08-12 15:38:38 +0200663EXPORT_SYMBOL(cfg80211_rx_mgmt);
Jouni Malinen026331c2010-02-15 12:53:10 +0200664
Simon Wunderlich04f39042013-02-08 18:16:19 +0100665void cfg80211_dfs_channels_update_work(struct work_struct *work)
666{
667 struct delayed_work *delayed_work;
668 struct cfg80211_registered_device *rdev;
669 struct cfg80211_chan_def chandef;
670 struct ieee80211_supported_band *sband;
671 struct ieee80211_channel *c;
672 struct wiphy *wiphy;
673 bool check_again = false;
674 unsigned long timeout, next_time = 0;
675 int bandid, i;
676
677 delayed_work = container_of(work, struct delayed_work, work);
678 rdev = container_of(delayed_work, struct cfg80211_registered_device,
679 dfs_update_channels_wk);
680 wiphy = &rdev->wiphy;
681
Johannes Berg5fe231e2013-05-08 21:45:15 +0200682 rtnl_lock();
Simon Wunderlich04f39042013-02-08 18:16:19 +0100683 for (bandid = 0; bandid < IEEE80211_NUM_BANDS; bandid++) {
684 sband = wiphy->bands[bandid];
685 if (!sband)
686 continue;
687
688 for (i = 0; i < sband->n_channels; i++) {
689 c = &sband->channels[i];
690
691 if (c->dfs_state != NL80211_DFS_UNAVAILABLE)
692 continue;
693
Michal Kaziorc532a582013-10-17 11:21:11 -0700694 timeout = c->dfs_state_entered + msecs_to_jiffies(
695 IEEE80211_DFS_MIN_NOP_TIME_MS);
Simon Wunderlich04f39042013-02-08 18:16:19 +0100696
697 if (time_after_eq(jiffies, timeout)) {
698 c->dfs_state = NL80211_DFS_USABLE;
Michal Kaziorbbe09bb2013-10-17 11:21:12 -0700699 c->dfs_state_entered = jiffies;
700
Simon Wunderlich04f39042013-02-08 18:16:19 +0100701 cfg80211_chandef_create(&chandef, c,
702 NL80211_CHAN_NO_HT);
703
704 nl80211_radar_notify(rdev, &chandef,
705 NL80211_RADAR_NOP_FINISHED,
706 NULL, GFP_ATOMIC);
707 continue;
708 }
709
710 if (!check_again)
711 next_time = timeout - jiffies;
712 else
713 next_time = min(next_time, timeout - jiffies);
714 check_again = true;
715 }
716 }
Johannes Berg5fe231e2013-05-08 21:45:15 +0200717 rtnl_unlock();
Simon Wunderlich04f39042013-02-08 18:16:19 +0100718
719 /* reschedule if there are other channels waiting to be cleared again */
720 if (check_again)
721 queue_delayed_work(cfg80211_wq, &rdev->dfs_update_channels_wk,
722 next_time);
723}
724
725
726void cfg80211_radar_event(struct wiphy *wiphy,
727 struct cfg80211_chan_def *chandef,
728 gfp_t gfp)
729{
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800730 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Simon Wunderlich04f39042013-02-08 18:16:19 +0100731 unsigned long timeout;
732
733 trace_cfg80211_radar_event(wiphy, chandef);
734
735 /* only set the chandef supplied channel to unavailable, in
736 * case the radar is detected on only one of multiple channels
737 * spanned by the chandef.
738 */
739 cfg80211_set_dfs_state(wiphy, chandef, NL80211_DFS_UNAVAILABLE);
740
741 timeout = msecs_to_jiffies(IEEE80211_DFS_MIN_NOP_TIME_MS);
742 queue_delayed_work(cfg80211_wq, &rdev->dfs_update_channels_wk,
743 timeout);
744
745 nl80211_radar_notify(rdev, chandef, NL80211_RADAR_DETECTED, NULL, gfp);
746}
747EXPORT_SYMBOL(cfg80211_radar_event);
748
749void cfg80211_cac_event(struct net_device *netdev,
Janusz Dziedzicd2859df2013-11-06 13:55:51 +0100750 const struct cfg80211_chan_def *chandef,
Simon Wunderlich04f39042013-02-08 18:16:19 +0100751 enum nl80211_radar_event event, gfp_t gfp)
752{
753 struct wireless_dev *wdev = netdev->ieee80211_ptr;
754 struct wiphy *wiphy = wdev->wiphy;
Zhao, Gangf26cbf42014-04-21 12:53:03 +0800755 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
Simon Wunderlich04f39042013-02-08 18:16:19 +0100756 unsigned long timeout;
757
758 trace_cfg80211_cac_event(netdev, event);
759
760 if (WARN_ON(!wdev->cac_started))
761 return;
762
Michal Kazior9e0e2962014-01-29 14:22:27 +0100763 if (WARN_ON(!wdev->chandef.chan))
Simon Wunderlich04f39042013-02-08 18:16:19 +0100764 return;
765
Simon Wunderlich04f39042013-02-08 18:16:19 +0100766 switch (event) {
767 case NL80211_RADAR_CAC_FINISHED:
768 timeout = wdev->cac_start_time +
Janusz Dziedzic31559f32014-02-21 19:46:13 +0100769 msecs_to_jiffies(wdev->cac_time_ms);
Simon Wunderlich04f39042013-02-08 18:16:19 +0100770 WARN_ON(!time_after_eq(jiffies, timeout));
Janusz Dziedzicd2859df2013-11-06 13:55:51 +0100771 cfg80211_set_dfs_state(wiphy, chandef, NL80211_DFS_AVAILABLE);
Simon Wunderlich04f39042013-02-08 18:16:19 +0100772 break;
773 case NL80211_RADAR_CAC_ABORTED:
774 break;
775 default:
776 WARN_ON(1);
777 return;
778 }
779 wdev->cac_started = false;
780
Janusz Dziedzicd2859df2013-11-06 13:55:51 +0100781 nl80211_radar_notify(rdev, chandef, event, netdev, gfp);
Simon Wunderlich04f39042013-02-08 18:16:19 +0100782}
783EXPORT_SYMBOL(cfg80211_cac_event);