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