1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Some IBSS support code for cfg80211.
4 *
5 * Copyright 2009 Johannes Berg <johannes@sipsolutions.net>
6 * Copyright (C) 2020-2022 Intel Corporation
7 */
8
9 #include <linux/etherdevice.h>
10 #include <linux/if_arp.h>
11 #include <linux/slab.h>
12 #include <linux/export.h>
13 #include <net/cfg80211.h>
14 #include "wext-compat.h"
15 #include "nl80211.h"
16 #include "rdev-ops.h"
17
18
__cfg80211_ibss_joined(struct net_device * dev,const u8 * bssid,struct ieee80211_channel * channel)19 void __cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
20 struct ieee80211_channel *channel)
21 {
22 struct wireless_dev *wdev = dev->ieee80211_ptr;
23 struct cfg80211_bss *bss;
24 #ifdef CONFIG_CFG80211_WEXT
25 union iwreq_data wrqu;
26 #endif
27
28 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
29 return;
30
31 if (!wdev->u.ibss.ssid_len)
32 return;
33
34 bss = cfg80211_get_bss(wdev->wiphy, channel, bssid, NULL, 0,
35 IEEE80211_BSS_TYPE_IBSS, IEEE80211_PRIVACY_ANY);
36
37 if (WARN_ON(!bss))
38 return;
39
40 if (wdev->u.ibss.current_bss) {
41 cfg80211_unhold_bss(wdev->u.ibss.current_bss);
42 cfg80211_put_bss(wdev->wiphy, &wdev->u.ibss.current_bss->pub);
43 }
44
45 cfg80211_hold_bss(bss_from_pub(bss));
46 wdev->u.ibss.current_bss = bss_from_pub(bss);
47
48 if (!(wdev->wiphy->flags & WIPHY_FLAG_HAS_STATIC_WEP))
49 cfg80211_upload_connect_keys(wdev);
50
51 nl80211_send_ibss_bssid(wiphy_to_rdev(wdev->wiphy), dev, bssid,
52 GFP_KERNEL);
53 #ifdef CONFIG_CFG80211_WEXT
54 memset(&wrqu, 0, sizeof(wrqu));
55 memcpy(wrqu.ap_addr.sa_data, bssid, ETH_ALEN);
56 wireless_send_event(dev, SIOCGIWAP, &wrqu, NULL);
57 #endif
58 }
59
cfg80211_ibss_joined(struct net_device * dev,const u8 * bssid,struct ieee80211_channel * channel,gfp_t gfp)60 void cfg80211_ibss_joined(struct net_device *dev, const u8 *bssid,
61 struct ieee80211_channel *channel, gfp_t gfp)
62 {
63 struct wireless_dev *wdev = dev->ieee80211_ptr;
64 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
65 struct cfg80211_event *ev;
66 unsigned long flags;
67
68 trace_cfg80211_ibss_joined(dev, bssid, channel);
69
70 if (WARN_ON(!channel))
71 return;
72
73 ev = kzalloc(sizeof(*ev), gfp);
74 if (!ev)
75 return;
76
77 ev->type = EVENT_IBSS_JOINED;
78 memcpy(ev->ij.bssid, bssid, ETH_ALEN);
79 ev->ij.channel = channel;
80
81 spin_lock_irqsave(&wdev->event_lock, flags);
82 list_add_tail(&ev->list, &wdev->event_list);
83 spin_unlock_irqrestore(&wdev->event_lock, flags);
84 queue_work(cfg80211_wq, &rdev->event_work);
85 }
86 EXPORT_SYMBOL(cfg80211_ibss_joined);
87
__cfg80211_join_ibss(struct cfg80211_registered_device * rdev,struct net_device * dev,struct cfg80211_ibss_params * params,struct cfg80211_cached_keys * connkeys)88 int __cfg80211_join_ibss(struct cfg80211_registered_device *rdev,
89 struct net_device *dev,
90 struct cfg80211_ibss_params *params,
91 struct cfg80211_cached_keys *connkeys)
92 {
93 struct wireless_dev *wdev = dev->ieee80211_ptr;
94 int err;
95
96 lockdep_assert_held(&rdev->wiphy.mtx);
97 ASSERT_WDEV_LOCK(wdev);
98
99 if (wdev->u.ibss.ssid_len)
100 return -EALREADY;
101
102 if (!params->basic_rates) {
103 /*
104 * If no rates were explicitly configured,
105 * use the mandatory rate set for 11b or
106 * 11a for maximum compatibility.
107 */
108 struct ieee80211_supported_band *sband;
109 enum nl80211_band band;
110 u32 flag;
111 int j;
112
113 band = params->chandef.chan->band;
114 if (band == NL80211_BAND_5GHZ ||
115 band == NL80211_BAND_6GHZ)
116 flag = IEEE80211_RATE_MANDATORY_A;
117 else
118 flag = IEEE80211_RATE_MANDATORY_B;
119
120 sband = rdev->wiphy.bands[band];
121 for (j = 0; j < sband->n_bitrates; j++) {
122 if (sband->bitrates[j].flags & flag)
123 params->basic_rates |= BIT(j);
124 }
125 }
126
127 if (WARN_ON(connkeys && connkeys->def < 0))
128 return -EINVAL;
129
130 if (WARN_ON(wdev->connect_keys))
131 kfree_sensitive(wdev->connect_keys);
132 wdev->connect_keys = connkeys;
133
134 wdev->u.ibss.chandef = params->chandef;
135 if (connkeys) {
136 params->wep_keys = connkeys->params;
137 params->wep_tx_key = connkeys->def;
138 }
139
140 #ifdef CONFIG_CFG80211_WEXT
141 wdev->wext.ibss.chandef = params->chandef;
142 #endif
143 err = rdev_join_ibss(rdev, dev, params);
144 if (err) {
145 wdev->connect_keys = NULL;
146 return err;
147 }
148
149 memcpy(wdev->u.ibss.ssid, params->ssid, params->ssid_len);
150 wdev->u.ibss.ssid_len = params->ssid_len;
151
152 return 0;
153 }
154
__cfg80211_clear_ibss(struct net_device * dev,bool nowext)155 static void __cfg80211_clear_ibss(struct net_device *dev, bool nowext)
156 {
157 struct wireless_dev *wdev = dev->ieee80211_ptr;
158 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
159 int i;
160
161 ASSERT_WDEV_LOCK(wdev);
162
163 kfree_sensitive(wdev->connect_keys);
164 wdev->connect_keys = NULL;
165
166 rdev_set_qos_map(rdev, dev, NULL);
167
168 /*
169 * Delete all the keys ... pairwise keys can't really
170 * exist any more anyway, but default keys might.
171 */
172 if (rdev->ops->del_key)
173 for (i = 0; i < 6; i++)
174 rdev_del_key(rdev, dev, -1, i, false, NULL);
175
176 if (wdev->u.ibss.current_bss) {
177 cfg80211_unhold_bss(wdev->u.ibss.current_bss);
178 cfg80211_put_bss(wdev->wiphy, &wdev->u.ibss.current_bss->pub);
179 }
180
181 wdev->u.ibss.current_bss = NULL;
182 wdev->u.ibss.ssid_len = 0;
183 memset(&wdev->u.ibss.chandef, 0, sizeof(wdev->u.ibss.chandef));
184 #ifdef CONFIG_CFG80211_WEXT
185 if (!nowext)
186 wdev->wext.ibss.ssid_len = 0;
187 #endif
188 cfg80211_sched_dfs_chan_update(rdev);
189 }
190
cfg80211_clear_ibss(struct net_device * dev,bool nowext)191 void cfg80211_clear_ibss(struct net_device *dev, bool nowext)
192 {
193 struct wireless_dev *wdev = dev->ieee80211_ptr;
194
195 wdev_lock(wdev);
196 __cfg80211_clear_ibss(dev, nowext);
197 wdev_unlock(wdev);
198 }
199
__cfg80211_leave_ibss(struct cfg80211_registered_device * rdev,struct net_device * dev,bool nowext)200 int __cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
201 struct net_device *dev, bool nowext)
202 {
203 struct wireless_dev *wdev = dev->ieee80211_ptr;
204 int err;
205
206 ASSERT_WDEV_LOCK(wdev);
207
208 if (!wdev->u.ibss.ssid_len)
209 return -ENOLINK;
210
211 err = rdev_leave_ibss(rdev, dev);
212
213 if (err)
214 return err;
215
216 wdev->conn_owner_nlportid = 0;
217 __cfg80211_clear_ibss(dev, nowext);
218
219 return 0;
220 }
221
cfg80211_leave_ibss(struct cfg80211_registered_device * rdev,struct net_device * dev,bool nowext)222 int cfg80211_leave_ibss(struct cfg80211_registered_device *rdev,
223 struct net_device *dev, bool nowext)
224 {
225 struct wireless_dev *wdev = dev->ieee80211_ptr;
226 int err;
227
228 wdev_lock(wdev);
229 err = __cfg80211_leave_ibss(rdev, dev, nowext);
230 wdev_unlock(wdev);
231
232 return err;
233 }
234
235 #ifdef CONFIG_CFG80211_WEXT
cfg80211_ibss_wext_join(struct cfg80211_registered_device * rdev,struct wireless_dev * wdev)236 int cfg80211_ibss_wext_join(struct cfg80211_registered_device *rdev,
237 struct wireless_dev *wdev)
238 {
239 struct cfg80211_cached_keys *ck = NULL;
240 enum nl80211_band band;
241 int i, err;
242
243 ASSERT_WDEV_LOCK(wdev);
244
245 if (!wdev->wext.ibss.beacon_interval)
246 wdev->wext.ibss.beacon_interval = 100;
247
248 /* try to find an IBSS channel if none requested ... */
249 if (!wdev->wext.ibss.chandef.chan) {
250 struct ieee80211_channel *new_chan = NULL;
251
252 for (band = 0; band < NUM_NL80211_BANDS; band++) {
253 struct ieee80211_supported_band *sband;
254 struct ieee80211_channel *chan;
255
256 sband = rdev->wiphy.bands[band];
257 if (!sband)
258 continue;
259
260 for (i = 0; i < sband->n_channels; i++) {
261 chan = &sband->channels[i];
262 if (chan->flags & IEEE80211_CHAN_NO_IR)
263 continue;
264 if (chan->flags & IEEE80211_CHAN_DISABLED)
265 continue;
266 new_chan = chan;
267 break;
268 }
269
270 if (new_chan)
271 break;
272 }
273
274 if (!new_chan)
275 return -EINVAL;
276
277 cfg80211_chandef_create(&wdev->wext.ibss.chandef, new_chan,
278 NL80211_CHAN_NO_HT);
279 }
280
281 /* don't join -- SSID is not there */
282 if (!wdev->wext.ibss.ssid_len)
283 return 0;
284
285 if (!netif_running(wdev->netdev))
286 return 0;
287
288 if (wdev->wext.keys)
289 wdev->wext.keys->def = wdev->wext.default_key;
290
291 wdev->wext.ibss.privacy = wdev->wext.default_key != -1;
292
293 if (wdev->wext.keys && wdev->wext.keys->def != -1) {
294 ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL);
295 if (!ck)
296 return -ENOMEM;
297 for (i = 0; i < CFG80211_MAX_WEP_KEYS; i++)
298 ck->params[i].key = ck->data[i];
299 }
300 err = __cfg80211_join_ibss(rdev, wdev->netdev,
301 &wdev->wext.ibss, ck);
302 if (err)
303 kfree(ck);
304
305 return err;
306 }
307
cfg80211_ibss_wext_siwfreq(struct net_device * dev,struct iw_request_info * info,struct iw_freq * wextfreq,char * extra)308 int cfg80211_ibss_wext_siwfreq(struct net_device *dev,
309 struct iw_request_info *info,
310 struct iw_freq *wextfreq, char *extra)
311 {
312 struct wireless_dev *wdev = dev->ieee80211_ptr;
313 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
314 struct ieee80211_channel *chan = NULL;
315 int err, freq;
316
317 /* call only for ibss! */
318 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
319 return -EINVAL;
320
321 if (!rdev->ops->join_ibss)
322 return -EOPNOTSUPP;
323
324 freq = cfg80211_wext_freq(wextfreq);
325 if (freq < 0)
326 return freq;
327
328 if (freq) {
329 chan = ieee80211_get_channel(wdev->wiphy, freq);
330 if (!chan)
331 return -EINVAL;
332 if (chan->flags & IEEE80211_CHAN_NO_IR ||
333 chan->flags & IEEE80211_CHAN_DISABLED)
334 return -EINVAL;
335 }
336
337 if (wdev->wext.ibss.chandef.chan == chan)
338 return 0;
339
340 wdev_lock(wdev);
341 err = 0;
342 if (wdev->u.ibss.ssid_len)
343 err = __cfg80211_leave_ibss(rdev, dev, true);
344 wdev_unlock(wdev);
345
346 if (err)
347 return err;
348
349 if (chan) {
350 cfg80211_chandef_create(&wdev->wext.ibss.chandef, chan,
351 NL80211_CHAN_NO_HT);
352 wdev->wext.ibss.channel_fixed = true;
353 } else {
354 /* cfg80211_ibss_wext_join will pick one if needed */
355 wdev->wext.ibss.channel_fixed = false;
356 }
357
358 wdev_lock(wdev);
359 err = cfg80211_ibss_wext_join(rdev, wdev);
360 wdev_unlock(wdev);
361
362 return err;
363 }
364
cfg80211_ibss_wext_giwfreq(struct net_device * dev,struct iw_request_info * info,struct iw_freq * freq,char * extra)365 int cfg80211_ibss_wext_giwfreq(struct net_device *dev,
366 struct iw_request_info *info,
367 struct iw_freq *freq, char *extra)
368 {
369 struct wireless_dev *wdev = dev->ieee80211_ptr;
370 struct ieee80211_channel *chan = NULL;
371
372 /* call only for ibss! */
373 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
374 return -EINVAL;
375
376 wdev_lock(wdev);
377 if (wdev->u.ibss.current_bss)
378 chan = wdev->u.ibss.current_bss->pub.channel;
379 else if (wdev->wext.ibss.chandef.chan)
380 chan = wdev->wext.ibss.chandef.chan;
381 wdev_unlock(wdev);
382
383 if (chan) {
384 freq->m = chan->center_freq;
385 freq->e = 6;
386 return 0;
387 }
388
389 /* no channel if not joining */
390 return -EINVAL;
391 }
392
cfg80211_ibss_wext_siwessid(struct net_device * dev,struct iw_request_info * info,struct iw_point * data,char * ssid)393 int cfg80211_ibss_wext_siwessid(struct net_device *dev,
394 struct iw_request_info *info,
395 struct iw_point *data, char *ssid)
396 {
397 struct wireless_dev *wdev = dev->ieee80211_ptr;
398 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
399 size_t len = data->length;
400 int err;
401
402 /* call only for ibss! */
403 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
404 return -EINVAL;
405
406 if (!rdev->ops->join_ibss)
407 return -EOPNOTSUPP;
408
409 wdev_lock(wdev);
410 err = 0;
411 if (wdev->u.ibss.ssid_len)
412 err = __cfg80211_leave_ibss(rdev, dev, true);
413 wdev_unlock(wdev);
414
415 if (err)
416 return err;
417
418 /* iwconfig uses nul termination in SSID.. */
419 if (len > 0 && ssid[len - 1] == '\0')
420 len--;
421
422 memcpy(wdev->u.ibss.ssid, ssid, len);
423 wdev->wext.ibss.ssid = wdev->u.ibss.ssid;
424 wdev->wext.ibss.ssid_len = len;
425
426 wdev_lock(wdev);
427 err = cfg80211_ibss_wext_join(rdev, wdev);
428 wdev_unlock(wdev);
429
430 return err;
431 }
432
cfg80211_ibss_wext_giwessid(struct net_device * dev,struct iw_request_info * info,struct iw_point * data,char * ssid)433 int cfg80211_ibss_wext_giwessid(struct net_device *dev,
434 struct iw_request_info *info,
435 struct iw_point *data, char *ssid)
436 {
437 struct wireless_dev *wdev = dev->ieee80211_ptr;
438
439 /* call only for ibss! */
440 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
441 return -EINVAL;
442
443 data->flags = 0;
444
445 wdev_lock(wdev);
446 if (wdev->u.ibss.ssid_len) {
447 data->flags = 1;
448 data->length = wdev->u.ibss.ssid_len;
449 memcpy(ssid, wdev->u.ibss.ssid, data->length);
450 } else if (wdev->wext.ibss.ssid && wdev->wext.ibss.ssid_len) {
451 data->flags = 1;
452 data->length = wdev->wext.ibss.ssid_len;
453 memcpy(ssid, wdev->wext.ibss.ssid, data->length);
454 }
455 wdev_unlock(wdev);
456
457 return 0;
458 }
459
cfg80211_ibss_wext_siwap(struct net_device * dev,struct iw_request_info * info,struct sockaddr * ap_addr,char * extra)460 int cfg80211_ibss_wext_siwap(struct net_device *dev,
461 struct iw_request_info *info,
462 struct sockaddr *ap_addr, char *extra)
463 {
464 struct wireless_dev *wdev = dev->ieee80211_ptr;
465 struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
466 u8 *bssid = ap_addr->sa_data;
467 int err;
468
469 /* call only for ibss! */
470 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
471 return -EINVAL;
472
473 if (!rdev->ops->join_ibss)
474 return -EOPNOTSUPP;
475
476 if (ap_addr->sa_family != ARPHRD_ETHER)
477 return -EINVAL;
478
479 /* automatic mode */
480 if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid))
481 bssid = NULL;
482
483 if (bssid && !is_valid_ether_addr(bssid))
484 return -EINVAL;
485
486 /* both automatic */
487 if (!bssid && !wdev->wext.ibss.bssid)
488 return 0;
489
490 /* fixed already - and no change */
491 if (wdev->wext.ibss.bssid && bssid &&
492 ether_addr_equal(bssid, wdev->wext.ibss.bssid))
493 return 0;
494
495 wdev_lock(wdev);
496 err = 0;
497 if (wdev->u.ibss.ssid_len)
498 err = __cfg80211_leave_ibss(rdev, dev, true);
499 wdev_unlock(wdev);
500
501 if (err)
502 return err;
503
504 if (bssid) {
505 memcpy(wdev->wext.bssid, bssid, ETH_ALEN);
506 wdev->wext.ibss.bssid = wdev->wext.bssid;
507 } else
508 wdev->wext.ibss.bssid = NULL;
509
510 wdev_lock(wdev);
511 err = cfg80211_ibss_wext_join(rdev, wdev);
512 wdev_unlock(wdev);
513
514 return err;
515 }
516
cfg80211_ibss_wext_giwap(struct net_device * dev,struct iw_request_info * info,struct sockaddr * ap_addr,char * extra)517 int cfg80211_ibss_wext_giwap(struct net_device *dev,
518 struct iw_request_info *info,
519 struct sockaddr *ap_addr, char *extra)
520 {
521 struct wireless_dev *wdev = dev->ieee80211_ptr;
522
523 /* call only for ibss! */
524 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_ADHOC))
525 return -EINVAL;
526
527 ap_addr->sa_family = ARPHRD_ETHER;
528
529 wdev_lock(wdev);
530 if (wdev->u.ibss.current_bss)
531 memcpy(ap_addr->sa_data, wdev->u.ibss.current_bss->pub.bssid,
532 ETH_ALEN);
533 else if (wdev->wext.ibss.bssid)
534 memcpy(ap_addr->sa_data, wdev->wext.ibss.bssid, ETH_ALEN);
535 else
536 eth_zero_addr(ap_addr->sa_data);
537
538 wdev_unlock(wdev);
539
540 return 0;
541 }
542 #endif
543