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