net/wireless/ibss.c

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