Commit | Line | Data |
---|---|---|
6039f6d2 JM |
1 | /* |
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> | |
c6fb08aa | 9 | #include <linux/etherdevice.h> |
6039f6d2 JM |
10 | #include <linux/netdevice.h> |
11 | #include <linux/nl80211.h> | |
5a0e3ad6 | 12 | #include <linux/slab.h> |
a9a11622 | 13 | #include <linux/wireless.h> |
6039f6d2 | 14 | #include <net/cfg80211.h> |
a9a11622 | 15 | #include <net/iw_handler.h> |
6039f6d2 JM |
16 | #include "core.h" |
17 | #include "nl80211.h" | |
e35e4d28 HG |
18 | #include "rdev-ops.h" |
19 | ||
6039f6d2 | 20 | |
cb0b4beb | 21 | void cfg80211_send_rx_auth(struct net_device *dev, const u8 *buf, size_t len) |
6039f6d2 | 22 | { |
19957bb3 JB |
23 | struct wireless_dev *wdev = dev->ieee80211_ptr; |
24 | struct wiphy *wiphy = wdev->wiphy; | |
6039f6d2 | 25 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); |
19957bb3 | 26 | |
4ee3e063 | 27 | trace_cfg80211_send_rx_auth(dev); |
667503dd | 28 | wdev_lock(wdev); |
cb0b4beb | 29 | |
95de817b JB |
30 | nl80211_send_rx_auth(rdev, dev, buf, len, GFP_KERNEL); |
31 | cfg80211_sme_rx_auth(dev, buf, len); | |
667503dd JB |
32 | |
33 | wdev_unlock(wdev); | |
6039f6d2 JM |
34 | } |
35 | EXPORT_SYMBOL(cfg80211_send_rx_auth); | |
36 | ||
95de817b JB |
37 | void cfg80211_send_rx_assoc(struct net_device *dev, struct cfg80211_bss *bss, |
38 | const u8 *buf, size_t len) | |
6039f6d2 | 39 | { |
6829c878 JB |
40 | u16 status_code; |
41 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
42 | struct wiphy *wiphy = wdev->wiphy; | |
6039f6d2 | 43 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); |
6829c878 JB |
44 | struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf; |
45 | u8 *ie = mgmt->u.assoc_resp.variable; | |
95de817b | 46 | int ieoffs = offsetof(struct ieee80211_mgmt, u.assoc_resp.variable); |
6829c878 | 47 | |
4ee3e063 | 48 | trace_cfg80211_send_rx_assoc(dev, bss); |
667503dd | 49 | wdev_lock(wdev); |
cb0b4beb | 50 | |
6829c878 JB |
51 | status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code); |
52 | ||
f401a6f7 JB |
53 | /* |
54 | * This is a bit of a hack, we don't notify userspace of | |
55 | * a (re-)association reply if we tried to send a reassoc | |
56 | * and got a reject -- we only try again with an assoc | |
57 | * frame instead of reassoc. | |
58 | */ | |
59 | if (status_code != WLAN_STATUS_SUCCESS && wdev->conn && | |
95de817b | 60 | cfg80211_sme_failed_reassoc(wdev)) { |
5b112d3d | 61 | cfg80211_put_bss(wiphy, bss); |
f401a6f7 | 62 | goto out; |
95de817b | 63 | } |
f401a6f7 | 64 | |
cb0b4beb | 65 | nl80211_send_rx_assoc(rdev, dev, buf, len, GFP_KERNEL); |
6829c878 | 66 | |
95de817b | 67 | if (status_code != WLAN_STATUS_SUCCESS && wdev->conn) { |
7d930bc3 | 68 | cfg80211_sme_failed_assoc(wdev); |
7d930bc3 JB |
69 | /* |
70 | * do not call connect_result() now because the | |
71 | * sme will schedule work that does it later. | |
72 | */ | |
5b112d3d | 73 | cfg80211_put_bss(wiphy, bss); |
7d930bc3 | 74 | goto out; |
df7fc0f9 JB |
75 | } |
76 | ||
ea416a79 JB |
77 | if (!wdev->conn && wdev->sme_state == CFG80211_SME_IDLE) { |
78 | /* | |
79 | * This is for the userspace SME, the CONNECTING | |
80 | * state will be changed to CONNECTED by | |
81 | * __cfg80211_connect_result() below. | |
82 | */ | |
83 | wdev->sme_state = CFG80211_SME_CONNECTING; | |
84 | } | |
85 | ||
95de817b | 86 | /* this consumes the bss reference */ |
df7fc0f9 JB |
87 | __cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, ie, len - ieoffs, |
88 | status_code, | |
95de817b | 89 | status_code == WLAN_STATUS_SUCCESS, bss); |
f401a6f7 | 90 | out: |
667503dd | 91 | wdev_unlock(wdev); |
6039f6d2 JM |
92 | } |
93 | EXPORT_SYMBOL(cfg80211_send_rx_assoc); | |
94 | ||
ce470613 | 95 | void __cfg80211_send_deauth(struct net_device *dev, |
667503dd | 96 | const u8 *buf, size_t len) |
6039f6d2 | 97 | { |
6829c878 JB |
98 | struct wireless_dev *wdev = dev->ieee80211_ptr; |
99 | struct wiphy *wiphy = wdev->wiphy; | |
6039f6d2 | 100 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); |
6829c878 | 101 | struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf; |
19957bb3 | 102 | const u8 *bssid = mgmt->bssid; |
95de817b | 103 | bool was_current = false; |
6829c878 | 104 | |
4ee3e063 | 105 | trace___cfg80211_send_deauth(dev); |
667503dd | 106 | ASSERT_WDEV_LOCK(wdev); |
cb0b4beb | 107 | |
19957bb3 | 108 | if (wdev->current_bss && |
ac422d3c | 109 | ether_addr_equal(wdev->current_bss->pub.bssid, bssid)) { |
19957bb3 | 110 | cfg80211_unhold_bss(wdev->current_bss); |
5b112d3d | 111 | cfg80211_put_bss(wiphy, &wdev->current_bss->pub); |
19957bb3 | 112 | wdev->current_bss = NULL; |
3f3b6a8d | 113 | was_current = true; |
19957bb3 | 114 | } |
19957bb3 | 115 | |
5fba4af3 JB |
116 | nl80211_send_deauth(rdev, dev, buf, len, GFP_KERNEL); |
117 | ||
3f3b6a8d | 118 | if (wdev->sme_state == CFG80211_SME_CONNECTED && was_current) { |
6829c878 JB |
119 | u16 reason_code; |
120 | bool from_ap; | |
121 | ||
122 | reason_code = le16_to_cpu(mgmt->u.deauth.reason_code); | |
123 | ||
ac422d3c | 124 | from_ap = !ether_addr_equal(mgmt->sa, dev->dev_addr); |
667503dd | 125 | __cfg80211_disconnected(dev, NULL, 0, reason_code, from_ap); |
6829c878 | 126 | } else if (wdev->sme_state == CFG80211_SME_CONNECTING) { |
667503dd JB |
127 | __cfg80211_connect_result(dev, mgmt->bssid, NULL, 0, NULL, 0, |
128 | WLAN_STATUS_UNSPECIFIED_FAILURE, | |
df7fc0f9 | 129 | false, NULL); |
667503dd JB |
130 | } |
131 | } | |
ce470613 | 132 | EXPORT_SYMBOL(__cfg80211_send_deauth); |
667503dd | 133 | |
ce470613 | 134 | void cfg80211_send_deauth(struct net_device *dev, const u8 *buf, size_t len) |
667503dd JB |
135 | { |
136 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
137 | ||
ce470613 HS |
138 | wdev_lock(wdev); |
139 | __cfg80211_send_deauth(dev, buf, len); | |
140 | wdev_unlock(wdev); | |
6039f6d2 | 141 | } |
53b46b84 | 142 | EXPORT_SYMBOL(cfg80211_send_deauth); |
6039f6d2 | 143 | |
ce470613 | 144 | void __cfg80211_send_disassoc(struct net_device *dev, |
667503dd | 145 | const u8 *buf, size_t len) |
6039f6d2 | 146 | { |
6829c878 JB |
147 | struct wireless_dev *wdev = dev->ieee80211_ptr; |
148 | struct wiphy *wiphy = wdev->wiphy; | |
6039f6d2 | 149 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); |
6829c878 | 150 | struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)buf; |
19957bb3 | 151 | const u8 *bssid = mgmt->bssid; |
19957bb3 JB |
152 | u16 reason_code; |
153 | bool from_ap; | |
6829c878 | 154 | |
4ee3e063 | 155 | trace___cfg80211_send_disassoc(dev); |
596a07c1 | 156 | ASSERT_WDEV_LOCK(wdev); |
cb0b4beb JB |
157 | |
158 | nl80211_send_disassoc(rdev, dev, buf, len, GFP_KERNEL); | |
a3b8b056 | 159 | |
596a07c1 JB |
160 | if (wdev->sme_state != CFG80211_SME_CONNECTED) |
161 | return; | |
6829c878 | 162 | |
19957bb3 | 163 | if (wdev->current_bss && |
ac422d3c | 164 | ether_addr_equal(wdev->current_bss->pub.bssid, bssid)) { |
95de817b JB |
165 | cfg80211_sme_disassoc(dev, wdev->current_bss); |
166 | cfg80211_unhold_bss(wdev->current_bss); | |
5b112d3d | 167 | cfg80211_put_bss(wiphy, &wdev->current_bss->pub); |
95de817b | 168 | wdev->current_bss = NULL; |
19957bb3 JB |
169 | } else |
170 | WARN_ON(1); | |
6829c878 | 171 | |
6829c878 | 172 | |
19957bb3 JB |
173 | reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code); |
174 | ||
ac422d3c | 175 | from_ap = !ether_addr_equal(mgmt->sa, dev->dev_addr); |
667503dd | 176 | __cfg80211_disconnected(dev, NULL, 0, reason_code, from_ap); |
667503dd | 177 | } |
ce470613 | 178 | EXPORT_SYMBOL(__cfg80211_send_disassoc); |
667503dd | 179 | |
ce470613 | 180 | void cfg80211_send_disassoc(struct net_device *dev, const u8 *buf, size_t len) |
667503dd JB |
181 | { |
182 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
183 | ||
ce470613 HS |
184 | wdev_lock(wdev); |
185 | __cfg80211_send_disassoc(dev, buf, len); | |
186 | wdev_unlock(wdev); | |
1965c853 | 187 | } |
6829c878 | 188 | EXPORT_SYMBOL(cfg80211_send_disassoc); |
1965c853 | 189 | |
a58ce43f JB |
190 | void cfg80211_send_auth_timeout(struct net_device *dev, const u8 *addr) |
191 | { | |
192 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
193 | struct wiphy *wiphy = wdev->wiphy; | |
194 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
195 | ||
4ee3e063 | 196 | trace_cfg80211_send_auth_timeout(dev, addr); |
a58ce43f JB |
197 | wdev_lock(wdev); |
198 | ||
199 | nl80211_send_auth_timeout(rdev, dev, addr, GFP_KERNEL); | |
200 | if (wdev->sme_state == CFG80211_SME_CONNECTING) | |
201 | __cfg80211_connect_result(dev, addr, NULL, 0, NULL, 0, | |
202 | WLAN_STATUS_UNSPECIFIED_FAILURE, | |
203 | false, NULL); | |
204 | ||
667503dd | 205 | wdev_unlock(wdev); |
1965c853 JM |
206 | } |
207 | EXPORT_SYMBOL(cfg80211_send_auth_timeout); | |
208 | ||
cb0b4beb | 209 | void cfg80211_send_assoc_timeout(struct net_device *dev, const u8 *addr) |
1965c853 | 210 | { |
6829c878 JB |
211 | struct wireless_dev *wdev = dev->ieee80211_ptr; |
212 | struct wiphy *wiphy = wdev->wiphy; | |
1965c853 | 213 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); |
19957bb3 | 214 | |
4ee3e063 | 215 | trace_cfg80211_send_assoc_timeout(dev, addr); |
667503dd | 216 | wdev_lock(wdev); |
cb0b4beb JB |
217 | |
218 | nl80211_send_assoc_timeout(rdev, dev, addr, GFP_KERNEL); | |
6829c878 | 219 | if (wdev->sme_state == CFG80211_SME_CONNECTING) |
667503dd JB |
220 | __cfg80211_connect_result(dev, addr, NULL, 0, NULL, 0, |
221 | WLAN_STATUS_UNSPECIFIED_FAILURE, | |
df7fc0f9 | 222 | false, NULL); |
19957bb3 | 223 | |
667503dd | 224 | wdev_unlock(wdev); |
1965c853 JM |
225 | } |
226 | EXPORT_SYMBOL(cfg80211_send_assoc_timeout); | |
227 | ||
a3b8b056 JM |
228 | void cfg80211_michael_mic_failure(struct net_device *dev, const u8 *addr, |
229 | enum nl80211_key_type key_type, int key_id, | |
e6d6e342 | 230 | const u8 *tsc, gfp_t gfp) |
a3b8b056 JM |
231 | { |
232 | struct wiphy *wiphy = dev->ieee80211_ptr->wiphy; | |
233 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
3d23e349 | 234 | #ifdef CONFIG_CFG80211_WEXT |
f58d4ed9 | 235 | union iwreq_data wrqu; |
e6d6e342 | 236 | char *buf = kmalloc(128, gfp); |
f58d4ed9 JB |
237 | |
238 | if (buf) { | |
239 | sprintf(buf, "MLME-MICHAELMICFAILURE.indication(" | |
240 | "keyid=%d %scast addr=%pM)", key_id, | |
241 | key_type == NL80211_KEYTYPE_GROUP ? "broad" : "uni", | |
242 | addr); | |
243 | memset(&wrqu, 0, sizeof(wrqu)); | |
244 | wrqu.data.length = strlen(buf); | |
245 | wireless_send_event(dev, IWEVCUSTOM, &wrqu, buf); | |
246 | kfree(buf); | |
247 | } | |
248 | #endif | |
249 | ||
4ee3e063 | 250 | trace_cfg80211_michael_mic_failure(dev, addr, key_type, key_id, tsc); |
e6d6e342 | 251 | nl80211_michael_mic_failure(rdev, dev, addr, key_type, key_id, tsc, gfp); |
a3b8b056 JM |
252 | } |
253 | EXPORT_SYMBOL(cfg80211_michael_mic_failure); | |
19957bb3 JB |
254 | |
255 | /* some MLME handling for userspace SME */ | |
667503dd JB |
256 | int __cfg80211_mlme_auth(struct cfg80211_registered_device *rdev, |
257 | struct net_device *dev, | |
258 | struct ieee80211_channel *chan, | |
259 | enum nl80211_auth_type auth_type, | |
260 | const u8 *bssid, | |
261 | const u8 *ssid, int ssid_len, | |
fffd0934 | 262 | const u8 *ie, int ie_len, |
e39e5b5e JM |
263 | const u8 *key, int key_len, int key_idx, |
264 | const u8 *sae_data, int sae_data_len) | |
19957bb3 JB |
265 | { |
266 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
267 | struct cfg80211_auth_request req; | |
95de817b | 268 | int err; |
19957bb3 | 269 | |
667503dd JB |
270 | ASSERT_WDEV_LOCK(wdev); |
271 | ||
fffd0934 JB |
272 | if (auth_type == NL80211_AUTHTYPE_SHARED_KEY) |
273 | if (!key || !key_len || key_idx < 0 || key_idx > 4) | |
274 | return -EINVAL; | |
275 | ||
0a9b5e17 | 276 | if (wdev->current_bss && |
ac422d3c | 277 | ether_addr_equal(bssid, wdev->current_bss->pub.bssid)) |
0a9b5e17 JB |
278 | return -EALREADY; |
279 | ||
19957bb3 JB |
280 | memset(&req, 0, sizeof(req)); |
281 | ||
282 | req.ie = ie; | |
283 | req.ie_len = ie_len; | |
e39e5b5e JM |
284 | req.sae_data = sae_data; |
285 | req.sae_data_len = sae_data_len; | |
19957bb3 JB |
286 | req.auth_type = auth_type; |
287 | req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, | |
288 | WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS); | |
fffd0934 JB |
289 | req.key = key; |
290 | req.key_len = key_len; | |
291 | req.key_idx = key_idx; | |
19957bb3 JB |
292 | if (!req.bss) |
293 | return -ENOENT; | |
294 | ||
e4e32459 MK |
295 | err = cfg80211_can_use_chan(rdev, wdev, req.bss->channel, |
296 | CHAN_MODE_SHARED); | |
297 | if (err) | |
298 | goto out; | |
299 | ||
e35e4d28 | 300 | err = rdev_auth(rdev, dev, &req); |
19957bb3 | 301 | |
e4e32459 | 302 | out: |
5b112d3d | 303 | cfg80211_put_bss(&rdev->wiphy, req.bss); |
19957bb3 JB |
304 | return err; |
305 | } | |
306 | ||
667503dd JB |
307 | int cfg80211_mlme_auth(struct cfg80211_registered_device *rdev, |
308 | struct net_device *dev, struct ieee80211_channel *chan, | |
309 | enum nl80211_auth_type auth_type, const u8 *bssid, | |
310 | const u8 *ssid, int ssid_len, | |
fffd0934 | 311 | const u8 *ie, int ie_len, |
e39e5b5e JM |
312 | const u8 *key, int key_len, int key_idx, |
313 | const u8 *sae_data, int sae_data_len) | |
667503dd JB |
314 | { |
315 | int err; | |
316 | ||
e4e32459 | 317 | mutex_lock(&rdev->devlist_mtx); |
667503dd JB |
318 | wdev_lock(dev->ieee80211_ptr); |
319 | err = __cfg80211_mlme_auth(rdev, dev, chan, auth_type, bssid, | |
fffd0934 | 320 | ssid, ssid_len, ie, ie_len, |
e39e5b5e JM |
321 | key, key_len, key_idx, |
322 | sae_data, sae_data_len); | |
667503dd | 323 | wdev_unlock(dev->ieee80211_ptr); |
e4e32459 | 324 | mutex_unlock(&rdev->devlist_mtx); |
667503dd JB |
325 | |
326 | return err; | |
327 | } | |
328 | ||
7e7c8926 BG |
329 | /* Do a logical ht_capa &= ht_capa_mask. */ |
330 | void cfg80211_oper_and_ht_capa(struct ieee80211_ht_cap *ht_capa, | |
331 | const struct ieee80211_ht_cap *ht_capa_mask) | |
332 | { | |
333 | int i; | |
334 | u8 *p1, *p2; | |
335 | if (!ht_capa_mask) { | |
336 | memset(ht_capa, 0, sizeof(*ht_capa)); | |
337 | return; | |
338 | } | |
339 | ||
340 | p1 = (u8*)(ht_capa); | |
341 | p2 = (u8*)(ht_capa_mask); | |
342 | for (i = 0; i<sizeof(*ht_capa); i++) | |
343 | p1[i] &= p2[i]; | |
344 | } | |
345 | ||
ee2aca34 JB |
346 | /* Do a logical ht_capa &= ht_capa_mask. */ |
347 | void cfg80211_oper_and_vht_capa(struct ieee80211_vht_cap *vht_capa, | |
348 | const struct ieee80211_vht_cap *vht_capa_mask) | |
349 | { | |
350 | int i; | |
351 | u8 *p1, *p2; | |
352 | if (!vht_capa_mask) { | |
353 | memset(vht_capa, 0, sizeof(*vht_capa)); | |
354 | return; | |
355 | } | |
356 | ||
357 | p1 = (u8*)(vht_capa); | |
358 | p2 = (u8*)(vht_capa_mask); | |
359 | for (i = 0; i < sizeof(*vht_capa); i++) | |
360 | p1[i] &= p2[i]; | |
361 | } | |
362 | ||
667503dd JB |
363 | int __cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev, |
364 | struct net_device *dev, | |
365 | struct ieee80211_channel *chan, | |
366 | const u8 *bssid, const u8 *prev_bssid, | |
367 | const u8 *ssid, int ssid_len, | |
368 | const u8 *ie, int ie_len, bool use_mfp, | |
7e7c8926 BG |
369 | struct cfg80211_crypto_settings *crypt, |
370 | u32 assoc_flags, struct ieee80211_ht_cap *ht_capa, | |
ee2aca34 JB |
371 | struct ieee80211_ht_cap *ht_capa_mask, |
372 | struct ieee80211_vht_cap *vht_capa, | |
373 | struct ieee80211_vht_cap *vht_capa_mask) | |
19957bb3 JB |
374 | { |
375 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
376 | struct cfg80211_assoc_request req; | |
95de817b | 377 | int err; |
24b6b15f | 378 | bool was_connected = false; |
19957bb3 | 379 | |
667503dd JB |
380 | ASSERT_WDEV_LOCK(wdev); |
381 | ||
19957bb3 JB |
382 | memset(&req, 0, sizeof(req)); |
383 | ||
24b6b15f | 384 | if (wdev->current_bss && prev_bssid && |
ac422d3c | 385 | ether_addr_equal(wdev->current_bss->pub.bssid, prev_bssid)) { |
24b6b15f JM |
386 | /* |
387 | * Trying to reassociate: Allow this to proceed and let the old | |
388 | * association to be dropped when the new one is completed. | |
389 | */ | |
390 | if (wdev->sme_state == CFG80211_SME_CONNECTED) { | |
391 | was_connected = true; | |
392 | wdev->sme_state = CFG80211_SME_CONNECTING; | |
393 | } | |
394 | } else if (wdev->current_bss) | |
19957bb3 JB |
395 | return -EALREADY; |
396 | ||
397 | req.ie = ie; | |
398 | req.ie_len = ie_len; | |
399 | memcpy(&req.crypto, crypt, sizeof(req.crypto)); | |
400 | req.use_mfp = use_mfp; | |
3e5d7649 | 401 | req.prev_bssid = prev_bssid; |
7e7c8926 BG |
402 | req.flags = assoc_flags; |
403 | if (ht_capa) | |
404 | memcpy(&req.ht_capa, ht_capa, sizeof(req.ht_capa)); | |
405 | if (ht_capa_mask) | |
406 | memcpy(&req.ht_capa_mask, ht_capa_mask, | |
407 | sizeof(req.ht_capa_mask)); | |
408 | cfg80211_oper_and_ht_capa(&req.ht_capa_mask, | |
409 | rdev->wiphy.ht_capa_mod_mask); | |
ee2aca34 JB |
410 | if (vht_capa) |
411 | memcpy(&req.vht_capa, vht_capa, sizeof(req.vht_capa)); | |
412 | if (vht_capa_mask) | |
413 | memcpy(&req.vht_capa_mask, vht_capa_mask, | |
414 | sizeof(req.vht_capa_mask)); | |
415 | cfg80211_oper_and_vht_capa(&req.vht_capa_mask, | |
416 | rdev->wiphy.vht_capa_mod_mask); | |
7e7c8926 | 417 | |
19957bb3 JB |
418 | req.bss = cfg80211_get_bss(&rdev->wiphy, chan, bssid, ssid, ssid_len, |
419 | WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS); | |
24b6b15f JM |
420 | if (!req.bss) { |
421 | if (was_connected) | |
422 | wdev->sme_state = CFG80211_SME_CONNECTED; | |
19957bb3 | 423 | return -ENOENT; |
24b6b15f | 424 | } |
19957bb3 | 425 | |
e4e32459 MK |
426 | err = cfg80211_can_use_chan(rdev, wdev, req.bss->channel, |
427 | CHAN_MODE_SHARED); | |
428 | if (err) | |
429 | goto out; | |
430 | ||
e35e4d28 | 431 | err = rdev_assoc(rdev, dev, &req); |
19957bb3 | 432 | |
e4e32459 | 433 | out: |
95de817b JB |
434 | if (err) { |
435 | if (was_connected) | |
436 | wdev->sme_state = CFG80211_SME_CONNECTED; | |
5b112d3d | 437 | cfg80211_put_bss(&rdev->wiphy, req.bss); |
19957bb3 JB |
438 | } |
439 | ||
19957bb3 JB |
440 | return err; |
441 | } | |
442 | ||
667503dd JB |
443 | int cfg80211_mlme_assoc(struct cfg80211_registered_device *rdev, |
444 | struct net_device *dev, | |
445 | struct ieee80211_channel *chan, | |
446 | const u8 *bssid, const u8 *prev_bssid, | |
447 | const u8 *ssid, int ssid_len, | |
448 | const u8 *ie, int ie_len, bool use_mfp, | |
7e7c8926 BG |
449 | struct cfg80211_crypto_settings *crypt, |
450 | u32 assoc_flags, struct ieee80211_ht_cap *ht_capa, | |
ee2aca34 JB |
451 | struct ieee80211_ht_cap *ht_capa_mask, |
452 | struct ieee80211_vht_cap *vht_capa, | |
453 | struct ieee80211_vht_cap *vht_capa_mask) | |
667503dd JB |
454 | { |
455 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
456 | int err; | |
457 | ||
e4e32459 | 458 | mutex_lock(&rdev->devlist_mtx); |
667503dd JB |
459 | wdev_lock(wdev); |
460 | err = __cfg80211_mlme_assoc(rdev, dev, chan, bssid, prev_bssid, | |
7e7c8926 | 461 | ssid, ssid_len, ie, ie_len, use_mfp, crypt, |
ee2aca34 JB |
462 | assoc_flags, ht_capa, ht_capa_mask, |
463 | vht_capa, vht_capa_mask); | |
667503dd | 464 | wdev_unlock(wdev); |
e4e32459 | 465 | mutex_unlock(&rdev->devlist_mtx); |
667503dd JB |
466 | |
467 | return err; | |
468 | } | |
469 | ||
470 | int __cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev, | |
471 | struct net_device *dev, const u8 *bssid, | |
d5cdfacb JM |
472 | const u8 *ie, int ie_len, u16 reason, |
473 | bool local_state_change) | |
19957bb3 JB |
474 | { |
475 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
95de817b JB |
476 | struct cfg80211_deauth_request req = { |
477 | .bssid = bssid, | |
478 | .reason_code = reason, | |
479 | .ie = ie, | |
480 | .ie_len = ie_len, | |
6863255b | 481 | .local_state_change = local_state_change, |
95de817b | 482 | }; |
19957bb3 | 483 | |
667503dd JB |
484 | ASSERT_WDEV_LOCK(wdev); |
485 | ||
6863255b SG |
486 | if (local_state_change && (!wdev->current_bss || |
487 | !ether_addr_equal(wdev->current_bss->pub.bssid, bssid))) | |
95de817b | 488 | return 0; |
19957bb3 | 489 | |
e35e4d28 | 490 | return rdev_deauth(rdev, dev, &req); |
19957bb3 JB |
491 | } |
492 | ||
667503dd JB |
493 | int cfg80211_mlme_deauth(struct cfg80211_registered_device *rdev, |
494 | struct net_device *dev, const u8 *bssid, | |
d5cdfacb JM |
495 | const u8 *ie, int ie_len, u16 reason, |
496 | bool local_state_change) | |
667503dd JB |
497 | { |
498 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
499 | int err; | |
500 | ||
501 | wdev_lock(wdev); | |
d5cdfacb JM |
502 | err = __cfg80211_mlme_deauth(rdev, dev, bssid, ie, ie_len, reason, |
503 | local_state_change); | |
667503dd JB |
504 | wdev_unlock(wdev); |
505 | ||
506 | return err; | |
507 | } | |
508 | ||
509 | static int __cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev, | |
510 | struct net_device *dev, const u8 *bssid, | |
d5cdfacb JM |
511 | const u8 *ie, int ie_len, u16 reason, |
512 | bool local_state_change) | |
19957bb3 JB |
513 | { |
514 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
515 | struct cfg80211_disassoc_request req; | |
516 | ||
667503dd JB |
517 | ASSERT_WDEV_LOCK(wdev); |
518 | ||
f9d6b402 JB |
519 | if (wdev->sme_state != CFG80211_SME_CONNECTED) |
520 | return -ENOTCONN; | |
521 | ||
8dcf011a | 522 | if (WARN(!wdev->current_bss, "sme_state=%d\n", wdev->sme_state)) |
f9d6b402 JB |
523 | return -ENOTCONN; |
524 | ||
19957bb3 JB |
525 | memset(&req, 0, sizeof(req)); |
526 | req.reason_code = reason; | |
d5cdfacb | 527 | req.local_state_change = local_state_change; |
19957bb3 JB |
528 | req.ie = ie; |
529 | req.ie_len = ie_len; | |
ac422d3c | 530 | if (ether_addr_equal(wdev->current_bss->pub.bssid, bssid)) |
19957bb3 JB |
531 | req.bss = &wdev->current_bss->pub; |
532 | else | |
533 | return -ENOTCONN; | |
534 | ||
e35e4d28 | 535 | return rdev_disassoc(rdev, dev, &req); |
667503dd JB |
536 | } |
537 | ||
538 | int cfg80211_mlme_disassoc(struct cfg80211_registered_device *rdev, | |
539 | struct net_device *dev, const u8 *bssid, | |
d5cdfacb JM |
540 | const u8 *ie, int ie_len, u16 reason, |
541 | bool local_state_change) | |
667503dd JB |
542 | { |
543 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
544 | int err; | |
545 | ||
546 | wdev_lock(wdev); | |
d5cdfacb JM |
547 | err = __cfg80211_mlme_disassoc(rdev, dev, bssid, ie, ie_len, reason, |
548 | local_state_change); | |
667503dd JB |
549 | wdev_unlock(wdev); |
550 | ||
551 | return err; | |
19957bb3 JB |
552 | } |
553 | ||
554 | void cfg80211_mlme_down(struct cfg80211_registered_device *rdev, | |
555 | struct net_device *dev) | |
556 | { | |
557 | struct wireless_dev *wdev = dev->ieee80211_ptr; | |
558 | struct cfg80211_deauth_request req; | |
95de817b | 559 | u8 bssid[ETH_ALEN]; |
19957bb3 | 560 | |
667503dd JB |
561 | ASSERT_WDEV_LOCK(wdev); |
562 | ||
19957bb3 JB |
563 | if (!rdev->ops->deauth) |
564 | return; | |
565 | ||
566 | memset(&req, 0, sizeof(req)); | |
567 | req.reason_code = WLAN_REASON_DEAUTH_LEAVING; | |
568 | req.ie = NULL; | |
569 | req.ie_len = 0; | |
570 | ||
95de817b JB |
571 | if (!wdev->current_bss) |
572 | return; | |
19957bb3 | 573 | |
95de817b JB |
574 | memcpy(bssid, wdev->current_bss->pub.bssid, ETH_ALEN); |
575 | req.bssid = bssid; | |
e35e4d28 | 576 | rdev_deauth(rdev, dev, &req); |
95de817b JB |
577 | |
578 | if (wdev->current_bss) { | |
579 | cfg80211_unhold_bss(wdev->current_bss); | |
5b112d3d | 580 | cfg80211_put_bss(&rdev->wiphy, &wdev->current_bss->pub); |
95de817b | 581 | wdev->current_bss = NULL; |
19957bb3 JB |
582 | } |
583 | } | |
9588bbd5 | 584 | |
2e161f78 | 585 | struct cfg80211_mgmt_registration { |
026331c4 JM |
586 | struct list_head list; |
587 | ||
15e47304 | 588 | u32 nlportid; |
026331c4 JM |
589 | |
590 | int match_len; | |
591 | ||
2e161f78 JB |
592 | __le16 frame_type; |
593 | ||
026331c4 JM |
594 | u8 match[]; |
595 | }; | |
596 | ||
15e47304 | 597 | int cfg80211_mlme_register_mgmt(struct wireless_dev *wdev, u32 snd_portid, |
2e161f78 JB |
598 | u16 frame_type, const u8 *match_data, |
599 | int match_len) | |
026331c4 | 600 | { |
271733cf JB |
601 | struct wiphy *wiphy = wdev->wiphy; |
602 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
2e161f78 | 603 | struct cfg80211_mgmt_registration *reg, *nreg; |
026331c4 | 604 | int err = 0; |
2e161f78 JB |
605 | u16 mgmt_type; |
606 | ||
607 | if (!wdev->wiphy->mgmt_stypes) | |
608 | return -EOPNOTSUPP; | |
609 | ||
610 | if ((frame_type & IEEE80211_FCTL_FTYPE) != IEEE80211_FTYPE_MGMT) | |
611 | return -EINVAL; | |
612 | ||
613 | if (frame_type & ~(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE)) | |
614 | return -EINVAL; | |
615 | ||
616 | mgmt_type = (frame_type & IEEE80211_FCTL_STYPE) >> 4; | |
617 | if (!(wdev->wiphy->mgmt_stypes[wdev->iftype].rx & BIT(mgmt_type))) | |
618 | return -EINVAL; | |
026331c4 JM |
619 | |
620 | nreg = kzalloc(sizeof(*reg) + match_len, GFP_KERNEL); | |
621 | if (!nreg) | |
622 | return -ENOMEM; | |
623 | ||
2e161f78 | 624 | spin_lock_bh(&wdev->mgmt_registrations_lock); |
026331c4 | 625 | |
2e161f78 | 626 | list_for_each_entry(reg, &wdev->mgmt_registrations, list) { |
026331c4 JM |
627 | int mlen = min(match_len, reg->match_len); |
628 | ||
2e161f78 JB |
629 | if (frame_type != le16_to_cpu(reg->frame_type)) |
630 | continue; | |
631 | ||
026331c4 JM |
632 | if (memcmp(reg->match, match_data, mlen) == 0) { |
633 | err = -EALREADY; | |
634 | break; | |
635 | } | |
636 | } | |
637 | ||
638 | if (err) { | |
639 | kfree(nreg); | |
640 | goto out; | |
641 | } | |
642 | ||
643 | memcpy(nreg->match, match_data, match_len); | |
644 | nreg->match_len = match_len; | |
15e47304 | 645 | nreg->nlportid = snd_portid; |
2e161f78 JB |
646 | nreg->frame_type = cpu_to_le16(frame_type); |
647 | list_add(&nreg->list, &wdev->mgmt_registrations); | |
026331c4 | 648 | |
271733cf | 649 | if (rdev->ops->mgmt_frame_register) |
e35e4d28 | 650 | rdev_mgmt_frame_register(rdev, wdev, frame_type, true); |
271733cf | 651 | |
026331c4 | 652 | out: |
2e161f78 | 653 | spin_unlock_bh(&wdev->mgmt_registrations_lock); |
271733cf | 654 | |
026331c4 JM |
655 | return err; |
656 | } | |
657 | ||
15e47304 | 658 | void cfg80211_mlme_unregister_socket(struct wireless_dev *wdev, u32 nlportid) |
026331c4 | 659 | { |
271733cf JB |
660 | struct wiphy *wiphy = wdev->wiphy; |
661 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
2e161f78 | 662 | struct cfg80211_mgmt_registration *reg, *tmp; |
026331c4 | 663 | |
2e161f78 | 664 | spin_lock_bh(&wdev->mgmt_registrations_lock); |
026331c4 | 665 | |
2e161f78 | 666 | list_for_each_entry_safe(reg, tmp, &wdev->mgmt_registrations, list) { |
15e47304 | 667 | if (reg->nlportid != nlportid) |
271733cf JB |
668 | continue; |
669 | ||
670 | if (rdev->ops->mgmt_frame_register) { | |
671 | u16 frame_type = le16_to_cpu(reg->frame_type); | |
672 | ||
e35e4d28 HG |
673 | rdev_mgmt_frame_register(rdev, wdev, |
674 | frame_type, false); | |
026331c4 | 675 | } |
271733cf JB |
676 | |
677 | list_del(®->list); | |
678 | kfree(reg); | |
026331c4 JM |
679 | } |
680 | ||
2e161f78 | 681 | spin_unlock_bh(&wdev->mgmt_registrations_lock); |
28946da7 | 682 | |
15e47304 EB |
683 | if (nlportid == wdev->ap_unexpected_nlportid) |
684 | wdev->ap_unexpected_nlportid = 0; | |
026331c4 JM |
685 | } |
686 | ||
2e161f78 | 687 | void cfg80211_mlme_purge_registrations(struct wireless_dev *wdev) |
026331c4 | 688 | { |
2e161f78 | 689 | struct cfg80211_mgmt_registration *reg, *tmp; |
026331c4 | 690 | |
2e161f78 | 691 | spin_lock_bh(&wdev->mgmt_registrations_lock); |
026331c4 | 692 | |
2e161f78 | 693 | list_for_each_entry_safe(reg, tmp, &wdev->mgmt_registrations, list) { |
026331c4 JM |
694 | list_del(®->list); |
695 | kfree(reg); | |
696 | } | |
697 | ||
2e161f78 | 698 | spin_unlock_bh(&wdev->mgmt_registrations_lock); |
026331c4 JM |
699 | } |
700 | ||
2e161f78 | 701 | int cfg80211_mlme_mgmt_tx(struct cfg80211_registered_device *rdev, |
71bbc994 | 702 | struct wireless_dev *wdev, |
f7ca38df | 703 | struct ieee80211_channel *chan, bool offchan, |
42d97a59 JB |
704 | unsigned int wait, const u8 *buf, size_t len, |
705 | bool no_cck, bool dont_wait_for_ack, u64 *cookie) | |
026331c4 | 706 | { |
026331c4 | 707 | const struct ieee80211_mgmt *mgmt; |
2e161f78 JB |
708 | u16 stype; |
709 | ||
710 | if (!wdev->wiphy->mgmt_stypes) | |
711 | return -EOPNOTSUPP; | |
026331c4 | 712 | |
2e161f78 | 713 | if (!rdev->ops->mgmt_tx) |
026331c4 | 714 | return -EOPNOTSUPP; |
2e161f78 | 715 | |
026331c4 JM |
716 | if (len < 24 + 1) |
717 | return -EINVAL; | |
718 | ||
719 | mgmt = (const struct ieee80211_mgmt *) buf; | |
2e161f78 JB |
720 | |
721 | if (!ieee80211_is_mgmt(mgmt->frame_control)) | |
026331c4 | 722 | return -EINVAL; |
2e161f78 JB |
723 | |
724 | stype = le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE; | |
725 | if (!(wdev->wiphy->mgmt_stypes[wdev->iftype].tx & BIT(stype >> 4))) | |
726 | return -EINVAL; | |
727 | ||
728 | if (ieee80211_is_action(mgmt->frame_control) && | |
729 | mgmt->u.action.category != WLAN_CATEGORY_PUBLIC) { | |
663fcafd JB |
730 | int err = 0; |
731 | ||
fe100acd JB |
732 | wdev_lock(wdev); |
733 | ||
663fcafd JB |
734 | switch (wdev->iftype) { |
735 | case NL80211_IFTYPE_ADHOC: | |
736 | case NL80211_IFTYPE_STATION: | |
737 | case NL80211_IFTYPE_P2P_CLIENT: | |
738 | if (!wdev->current_bss) { | |
739 | err = -ENOTCONN; | |
740 | break; | |
741 | } | |
742 | ||
ac422d3c JP |
743 | if (!ether_addr_equal(wdev->current_bss->pub.bssid, |
744 | mgmt->bssid)) { | |
663fcafd JB |
745 | err = -ENOTCONN; |
746 | break; | |
747 | } | |
748 | ||
749 | /* | |
750 | * check for IBSS DA must be done by driver as | |
751 | * cfg80211 doesn't track the stations | |
752 | */ | |
753 | if (wdev->iftype == NL80211_IFTYPE_ADHOC) | |
754 | break; | |
fe100acd | 755 | |
663fcafd | 756 | /* for station, check that DA is the AP */ |
ac422d3c JP |
757 | if (!ether_addr_equal(wdev->current_bss->pub.bssid, |
758 | mgmt->da)) { | |
663fcafd JB |
759 | err = -ENOTCONN; |
760 | break; | |
761 | } | |
762 | break; | |
763 | case NL80211_IFTYPE_AP: | |
764 | case NL80211_IFTYPE_P2P_GO: | |
765 | case NL80211_IFTYPE_AP_VLAN: | |
98104fde | 766 | if (!ether_addr_equal(mgmt->bssid, wdev_address(wdev))) |
663fcafd JB |
767 | err = -EINVAL; |
768 | break; | |
0778a6a3 | 769 | case NL80211_IFTYPE_MESH_POINT: |
ac422d3c | 770 | if (!ether_addr_equal(mgmt->sa, mgmt->bssid)) { |
0778a6a3 JC |
771 | err = -EINVAL; |
772 | break; | |
773 | } | |
774 | /* | |
775 | * check for mesh DA must be done by driver as | |
776 | * cfg80211 doesn't track the stations | |
777 | */ | |
778 | break; | |
98104fde JB |
779 | case NL80211_IFTYPE_P2P_DEVICE: |
780 | /* | |
781 | * fall through, P2P device only supports | |
782 | * public action frames | |
783 | */ | |
663fcafd JB |
784 | default: |
785 | err = -EOPNOTSUPP; | |
786 | break; | |
787 | } | |
fe100acd | 788 | wdev_unlock(wdev); |
663fcafd JB |
789 | |
790 | if (err) | |
791 | return err; | |
026331c4 JM |
792 | } |
793 | ||
98104fde | 794 | if (!ether_addr_equal(mgmt->sa, wdev_address(wdev))) |
026331c4 JM |
795 | return -EINVAL; |
796 | ||
797 | /* Transmit the Action frame as requested by user space */ | |
e35e4d28 | 798 | return rdev_mgmt_tx(rdev, wdev, chan, offchan, |
e35e4d28 HG |
799 | wait, buf, len, no_cck, dont_wait_for_ack, |
800 | cookie); | |
026331c4 JM |
801 | } |
802 | ||
71bbc994 | 803 | bool cfg80211_rx_mgmt(struct wireless_dev *wdev, int freq, int sig_mbm, |
804483e9 | 804 | const u8 *buf, size_t len, gfp_t gfp) |
026331c4 | 805 | { |
026331c4 JM |
806 | struct wiphy *wiphy = wdev->wiphy; |
807 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
2e161f78 JB |
808 | struct cfg80211_mgmt_registration *reg; |
809 | const struct ieee80211_txrx_stypes *stypes = | |
810 | &wiphy->mgmt_stypes[wdev->iftype]; | |
811 | struct ieee80211_mgmt *mgmt = (void *)buf; | |
812 | const u8 *data; | |
813 | int data_len; | |
026331c4 | 814 | bool result = false; |
2e161f78 JB |
815 | __le16 ftype = mgmt->frame_control & |
816 | cpu_to_le16(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE); | |
817 | u16 stype; | |
026331c4 | 818 | |
4ee3e063 | 819 | trace_cfg80211_rx_mgmt(wdev, freq, sig_mbm); |
2e161f78 | 820 | stype = (le16_to_cpu(mgmt->frame_control) & IEEE80211_FCTL_STYPE) >> 4; |
026331c4 | 821 | |
4ee3e063 BL |
822 | if (!(stypes->rx & BIT(stype))) { |
823 | trace_cfg80211_return_bool(false); | |
2e161f78 | 824 | return false; |
4ee3e063 | 825 | } |
026331c4 | 826 | |
2e161f78 JB |
827 | data = buf + ieee80211_hdrlen(mgmt->frame_control); |
828 | data_len = len - ieee80211_hdrlen(mgmt->frame_control); | |
829 | ||
830 | spin_lock_bh(&wdev->mgmt_registrations_lock); | |
831 | ||
832 | list_for_each_entry(reg, &wdev->mgmt_registrations, list) { | |
833 | if (reg->frame_type != ftype) | |
834 | continue; | |
026331c4 | 835 | |
2e161f78 | 836 | if (reg->match_len > data_len) |
026331c4 JM |
837 | continue; |
838 | ||
2e161f78 | 839 | if (memcmp(reg->match, data, reg->match_len)) |
026331c4 JM |
840 | continue; |
841 | ||
842 | /* found match! */ | |
843 | ||
844 | /* Indicate the received Action frame to user space */ | |
15e47304 | 845 | if (nl80211_send_mgmt(rdev, wdev, reg->nlportid, |
804483e9 | 846 | freq, sig_mbm, |
2e161f78 | 847 | buf, len, gfp)) |
026331c4 JM |
848 | continue; |
849 | ||
850 | result = true; | |
851 | break; | |
852 | } | |
853 | ||
2e161f78 | 854 | spin_unlock_bh(&wdev->mgmt_registrations_lock); |
026331c4 | 855 | |
4ee3e063 | 856 | trace_cfg80211_return_bool(result); |
026331c4 JM |
857 | return result; |
858 | } | |
2e161f78 | 859 | EXPORT_SYMBOL(cfg80211_rx_mgmt); |
026331c4 | 860 | |
04f39047 SW |
861 | void cfg80211_dfs_channels_update_work(struct work_struct *work) |
862 | { | |
863 | struct delayed_work *delayed_work; | |
864 | struct cfg80211_registered_device *rdev; | |
865 | struct cfg80211_chan_def chandef; | |
866 | struct ieee80211_supported_band *sband; | |
867 | struct ieee80211_channel *c; | |
868 | struct wiphy *wiphy; | |
869 | bool check_again = false; | |
870 | unsigned long timeout, next_time = 0; | |
871 | int bandid, i; | |
872 | ||
873 | delayed_work = container_of(work, struct delayed_work, work); | |
874 | rdev = container_of(delayed_work, struct cfg80211_registered_device, | |
875 | dfs_update_channels_wk); | |
876 | wiphy = &rdev->wiphy; | |
877 | ||
878 | mutex_lock(&cfg80211_mutex); | |
879 | for (bandid = 0; bandid < IEEE80211_NUM_BANDS; bandid++) { | |
880 | sband = wiphy->bands[bandid]; | |
881 | if (!sband) | |
882 | continue; | |
883 | ||
884 | for (i = 0; i < sband->n_channels; i++) { | |
885 | c = &sband->channels[i]; | |
886 | ||
887 | if (c->dfs_state != NL80211_DFS_UNAVAILABLE) | |
888 | continue; | |
889 | ||
890 | timeout = c->dfs_state_entered + | |
891 | IEEE80211_DFS_MIN_NOP_TIME_MS; | |
892 | ||
893 | if (time_after_eq(jiffies, timeout)) { | |
894 | c->dfs_state = NL80211_DFS_USABLE; | |
895 | cfg80211_chandef_create(&chandef, c, | |
896 | NL80211_CHAN_NO_HT); | |
897 | ||
898 | nl80211_radar_notify(rdev, &chandef, | |
899 | NL80211_RADAR_NOP_FINISHED, | |
900 | NULL, GFP_ATOMIC); | |
901 | continue; | |
902 | } | |
903 | ||
904 | if (!check_again) | |
905 | next_time = timeout - jiffies; | |
906 | else | |
907 | next_time = min(next_time, timeout - jiffies); | |
908 | check_again = true; | |
909 | } | |
910 | } | |
911 | mutex_unlock(&cfg80211_mutex); | |
912 | ||
913 | /* reschedule if there are other channels waiting to be cleared again */ | |
914 | if (check_again) | |
915 | queue_delayed_work(cfg80211_wq, &rdev->dfs_update_channels_wk, | |
916 | next_time); | |
917 | } | |
918 | ||
919 | ||
920 | void cfg80211_radar_event(struct wiphy *wiphy, | |
921 | struct cfg80211_chan_def *chandef, | |
922 | gfp_t gfp) | |
923 | { | |
924 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
925 | unsigned long timeout; | |
926 | ||
927 | trace_cfg80211_radar_event(wiphy, chandef); | |
928 | ||
929 | /* only set the chandef supplied channel to unavailable, in | |
930 | * case the radar is detected on only one of multiple channels | |
931 | * spanned by the chandef. | |
932 | */ | |
933 | cfg80211_set_dfs_state(wiphy, chandef, NL80211_DFS_UNAVAILABLE); | |
934 | ||
935 | timeout = msecs_to_jiffies(IEEE80211_DFS_MIN_NOP_TIME_MS); | |
936 | queue_delayed_work(cfg80211_wq, &rdev->dfs_update_channels_wk, | |
937 | timeout); | |
938 | ||
939 | nl80211_radar_notify(rdev, chandef, NL80211_RADAR_DETECTED, NULL, gfp); | |
940 | } | |
941 | EXPORT_SYMBOL(cfg80211_radar_event); | |
942 | ||
943 | void cfg80211_cac_event(struct net_device *netdev, | |
944 | enum nl80211_radar_event event, gfp_t gfp) | |
945 | { | |
946 | struct wireless_dev *wdev = netdev->ieee80211_ptr; | |
947 | struct wiphy *wiphy = wdev->wiphy; | |
948 | struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy); | |
949 | struct cfg80211_chan_def chandef; | |
950 | unsigned long timeout; | |
951 | ||
952 | trace_cfg80211_cac_event(netdev, event); | |
953 | ||
954 | if (WARN_ON(!wdev->cac_started)) | |
955 | return; | |
956 | ||
957 | if (WARN_ON(!wdev->channel)) | |
958 | return; | |
959 | ||
960 | cfg80211_chandef_create(&chandef, wdev->channel, NL80211_CHAN_NO_HT); | |
961 | ||
962 | switch (event) { | |
963 | case NL80211_RADAR_CAC_FINISHED: | |
964 | timeout = wdev->cac_start_time + | |
965 | msecs_to_jiffies(IEEE80211_DFS_MIN_CAC_TIME_MS); | |
966 | WARN_ON(!time_after_eq(jiffies, timeout)); | |
967 | cfg80211_set_dfs_state(wiphy, &chandef, NL80211_DFS_AVAILABLE); | |
968 | break; | |
969 | case NL80211_RADAR_CAC_ABORTED: | |
970 | break; | |
971 | default: | |
972 | WARN_ON(1); | |
973 | return; | |
974 | } | |
975 | wdev->cac_started = false; | |
976 | ||
977 | nl80211_radar_notify(rdev, &chandef, event, netdev, gfp); | |
978 | } | |
979 | EXPORT_SYMBOL(cfg80211_cac_event); |