1 /* 2 * cfg80211 wext compat for managed mode. 3 * 4 * Copyright 2009 Johannes Berg <johannes@sipsolutions.net> 5 * Copyright (C) 2009 Intel Corporation. All rights reserved. 6 */ 7 8 #include <linux/etherdevice.h> 9 #include <linux/if_arp.h> 10 #include <net/cfg80211.h> 11 #include "wext-compat.h" 12 #include "nl80211.h" 13 14 int cfg80211_mgd_wext_connect(struct cfg80211_registered_device *rdev, 15 struct wireless_dev *wdev) 16 { 17 struct cfg80211_cached_keys *ck = NULL; 18 const u8 *prev_bssid = NULL; 19 int err, i; 20 21 ASSERT_RDEV_LOCK(rdev); 22 ASSERT_WDEV_LOCK(wdev); 23 24 if (!netif_running(wdev->netdev)) 25 return 0; 26 27 wdev->wext.connect.ie = wdev->wext.ie; 28 wdev->wext.connect.ie_len = wdev->wext.ie_len; 29 wdev->wext.connect.privacy = wdev->wext.default_key != -1; 30 31 if (wdev->wext.keys) { 32 wdev->wext.keys->def = wdev->wext.default_key; 33 wdev->wext.keys->defmgmt = wdev->wext.default_mgmt_key; 34 } 35 36 if (!wdev->wext.connect.ssid_len) 37 return 0; 38 39 if (wdev->wext.keys) { 40 ck = kmemdup(wdev->wext.keys, sizeof(*ck), GFP_KERNEL); 41 if (!ck) 42 return -ENOMEM; 43 for (i = 0; i < 6; i++) 44 ck->params[i].key = ck->data[i]; 45 } 46 47 if (wdev->wext.prev_bssid_valid) 48 prev_bssid = wdev->wext.prev_bssid; 49 50 err = __cfg80211_connect(rdev, wdev->netdev, 51 &wdev->wext.connect, ck, prev_bssid); 52 if (err) 53 kfree(ck); 54 55 return err; 56 } 57 58 int cfg80211_mgd_wext_siwfreq(struct net_device *dev, 59 struct iw_request_info *info, 60 struct iw_freq *wextfreq, char *extra) 61 { 62 struct wireless_dev *wdev = dev->ieee80211_ptr; 63 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy); 64 struct ieee80211_channel *chan = NULL; 65 int err, freq; 66 67 /* call only for station! */ 68 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION)) 69 return -EINVAL; 70 71 freq = cfg80211_wext_freq(wdev->wiphy, wextfreq); 72 if (freq < 0) 73 return freq; 74 75 if (freq) { 76 chan = ieee80211_get_channel(wdev->wiphy, freq); 77 if (!chan) 78 return -EINVAL; 79 if (chan->flags & IEEE80211_CHAN_DISABLED) 80 return -EINVAL; 81 } 82 83 cfg80211_lock_rdev(rdev); 84 mutex_lock(&rdev->devlist_mtx); 85 wdev_lock(wdev); 86 87 if (wdev->sme_state != CFG80211_SME_IDLE) { 88 bool event = true; 89 90 if (wdev->wext.connect.channel == chan) { 91 err = 0; 92 goto out; 93 } 94 95 /* if SSID set, we'll try right again, avoid event */ 96 if (wdev->wext.connect.ssid_len) 97 event = false; 98 err = __cfg80211_disconnect(rdev, dev, 99 WLAN_REASON_DEAUTH_LEAVING, event); 100 if (err) 101 goto out; 102 } 103 104 105 wdev->wext.connect.channel = chan; 106 107 /* SSID is not set, we just want to switch channel */ 108 if (chan && !wdev->wext.connect.ssid_len) { 109 err = rdev_set_freq(rdev, wdev, freq, NL80211_CHAN_NO_HT); 110 goto out; 111 } 112 113 err = cfg80211_mgd_wext_connect(rdev, wdev); 114 out: 115 wdev_unlock(wdev); 116 mutex_unlock(&rdev->devlist_mtx); 117 cfg80211_unlock_rdev(rdev); 118 return err; 119 } 120 121 int cfg80211_mgd_wext_giwfreq(struct net_device *dev, 122 struct iw_request_info *info, 123 struct iw_freq *freq, char *extra) 124 { 125 struct wireless_dev *wdev = dev->ieee80211_ptr; 126 struct ieee80211_channel *chan = NULL; 127 128 /* call only for station! */ 129 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION)) 130 return -EINVAL; 131 132 wdev_lock(wdev); 133 if (wdev->current_bss) 134 chan = wdev->current_bss->pub.channel; 135 else if (wdev->wext.connect.channel) 136 chan = wdev->wext.connect.channel; 137 wdev_unlock(wdev); 138 139 if (chan) { 140 freq->m = chan->center_freq; 141 freq->e = 6; 142 return 0; 143 } 144 145 /* no channel if not joining */ 146 return -EINVAL; 147 } 148 149 int cfg80211_mgd_wext_siwessid(struct net_device *dev, 150 struct iw_request_info *info, 151 struct iw_point *data, char *ssid) 152 { 153 struct wireless_dev *wdev = dev->ieee80211_ptr; 154 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy); 155 size_t len = data->length; 156 int err; 157 158 /* call only for station! */ 159 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION)) 160 return -EINVAL; 161 162 if (!data->flags) 163 len = 0; 164 165 /* iwconfig uses nul termination in SSID.. */ 166 if (len > 0 && ssid[len - 1] == '\0') 167 len--; 168 169 cfg80211_lock_rdev(rdev); 170 mutex_lock(&rdev->devlist_mtx); 171 wdev_lock(wdev); 172 173 err = 0; 174 175 if (wdev->sme_state != CFG80211_SME_IDLE) { 176 bool event = true; 177 178 if (wdev->wext.connect.ssid && len && 179 len == wdev->wext.connect.ssid_len && 180 memcmp(wdev->wext.connect.ssid, ssid, len) == 0) 181 goto out; 182 183 /* if SSID set now, we'll try to connect, avoid event */ 184 if (len) 185 event = false; 186 err = __cfg80211_disconnect(rdev, dev, 187 WLAN_REASON_DEAUTH_LEAVING, event); 188 if (err) 189 goto out; 190 } 191 192 wdev->wext.prev_bssid_valid = false; 193 wdev->wext.connect.ssid = wdev->wext.ssid; 194 memcpy(wdev->wext.ssid, ssid, len); 195 wdev->wext.connect.ssid_len = len; 196 197 wdev->wext.connect.crypto.control_port = false; 198 199 err = cfg80211_mgd_wext_connect(rdev, wdev); 200 out: 201 wdev_unlock(wdev); 202 mutex_unlock(&rdev->devlist_mtx); 203 cfg80211_unlock_rdev(rdev); 204 return err; 205 } 206 207 int cfg80211_mgd_wext_giwessid(struct net_device *dev, 208 struct iw_request_info *info, 209 struct iw_point *data, char *ssid) 210 { 211 struct wireless_dev *wdev = dev->ieee80211_ptr; 212 213 /* call only for station! */ 214 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION)) 215 return -EINVAL; 216 217 data->flags = 0; 218 219 wdev_lock(wdev); 220 if (wdev->current_bss) { 221 const u8 *ie = ieee80211_bss_get_ie(&wdev->current_bss->pub, 222 WLAN_EID_SSID); 223 if (ie) { 224 data->flags = 1; 225 data->length = ie[1]; 226 memcpy(ssid, ie + 2, data->length); 227 } 228 } else if (wdev->wext.connect.ssid && wdev->wext.connect.ssid_len) { 229 data->flags = 1; 230 data->length = wdev->wext.connect.ssid_len; 231 memcpy(ssid, wdev->wext.connect.ssid, data->length); 232 } else 233 data->flags = 0; 234 wdev_unlock(wdev); 235 236 return 0; 237 } 238 239 int cfg80211_mgd_wext_siwap(struct net_device *dev, 240 struct iw_request_info *info, 241 struct sockaddr *ap_addr, char *extra) 242 { 243 struct wireless_dev *wdev = dev->ieee80211_ptr; 244 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy); 245 u8 *bssid = ap_addr->sa_data; 246 int err; 247 248 /* call only for station! */ 249 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION)) 250 return -EINVAL; 251 252 if (ap_addr->sa_family != ARPHRD_ETHER) 253 return -EINVAL; 254 255 /* automatic mode */ 256 if (is_zero_ether_addr(bssid) || is_broadcast_ether_addr(bssid)) 257 bssid = NULL; 258 259 cfg80211_lock_rdev(rdev); 260 mutex_lock(&rdev->devlist_mtx); 261 wdev_lock(wdev); 262 263 if (wdev->sme_state != CFG80211_SME_IDLE) { 264 err = 0; 265 /* both automatic */ 266 if (!bssid && !wdev->wext.connect.bssid) 267 goto out; 268 269 /* fixed already - and no change */ 270 if (wdev->wext.connect.bssid && bssid && 271 compare_ether_addr(bssid, wdev->wext.connect.bssid) == 0) 272 goto out; 273 274 err = __cfg80211_disconnect(rdev, dev, 275 WLAN_REASON_DEAUTH_LEAVING, false); 276 if (err) 277 goto out; 278 } 279 280 if (bssid) { 281 memcpy(wdev->wext.bssid, bssid, ETH_ALEN); 282 wdev->wext.connect.bssid = wdev->wext.bssid; 283 } else 284 wdev->wext.connect.bssid = NULL; 285 286 err = cfg80211_mgd_wext_connect(rdev, wdev); 287 out: 288 wdev_unlock(wdev); 289 mutex_unlock(&rdev->devlist_mtx); 290 cfg80211_unlock_rdev(rdev); 291 return err; 292 } 293 294 int cfg80211_mgd_wext_giwap(struct net_device *dev, 295 struct iw_request_info *info, 296 struct sockaddr *ap_addr, char *extra) 297 { 298 struct wireless_dev *wdev = dev->ieee80211_ptr; 299 300 /* call only for station! */ 301 if (WARN_ON(wdev->iftype != NL80211_IFTYPE_STATION)) 302 return -EINVAL; 303 304 ap_addr->sa_family = ARPHRD_ETHER; 305 306 wdev_lock(wdev); 307 if (wdev->current_bss) 308 memcpy(ap_addr->sa_data, wdev->current_bss->pub.bssid, ETH_ALEN); 309 else if (wdev->wext.connect.bssid) 310 memcpy(ap_addr->sa_data, wdev->wext.connect.bssid, ETH_ALEN); 311 else 312 memset(ap_addr->sa_data, 0, ETH_ALEN); 313 wdev_unlock(wdev); 314 315 return 0; 316 } 317 318 int cfg80211_wext_siwgenie(struct net_device *dev, 319 struct iw_request_info *info, 320 struct iw_point *data, char *extra) 321 { 322 struct wireless_dev *wdev = dev->ieee80211_ptr; 323 struct cfg80211_registered_device *rdev = wiphy_to_dev(wdev->wiphy); 324 u8 *ie = extra; 325 int ie_len = data->length, err; 326 327 if (wdev->iftype != NL80211_IFTYPE_STATION) 328 return -EOPNOTSUPP; 329 330 if (!ie_len) 331 ie = NULL; 332 333 wdev_lock(wdev); 334 335 /* no change */ 336 err = 0; 337 if (wdev->wext.ie_len == ie_len && 338 memcmp(wdev->wext.ie, ie, ie_len) == 0) 339 goto out; 340 341 if (ie_len) { 342 ie = kmemdup(extra, ie_len, GFP_KERNEL); 343 if (!ie) { 344 err = -ENOMEM; 345 goto out; 346 } 347 } else 348 ie = NULL; 349 350 kfree(wdev->wext.ie); 351 wdev->wext.ie = ie; 352 wdev->wext.ie_len = ie_len; 353 354 if (wdev->sme_state != CFG80211_SME_IDLE) { 355 err = __cfg80211_disconnect(rdev, dev, 356 WLAN_REASON_DEAUTH_LEAVING, false); 357 if (err) 358 goto out; 359 } 360 361 /* userspace better not think we'll reconnect */ 362 err = 0; 363 out: 364 wdev_unlock(wdev); 365 return err; 366 } 367 EXPORT_SYMBOL_GPL(cfg80211_wext_siwgenie); 368 369 int cfg80211_wext_siwmlme(struct net_device *dev, 370 struct iw_request_info *info, 371 struct iw_point *data, char *extra) 372 { 373 struct wireless_dev *wdev = dev->ieee80211_ptr; 374 struct iw_mlme *mlme = (struct iw_mlme *)extra; 375 struct cfg80211_registered_device *rdev; 376 int err; 377 378 if (!wdev) 379 return -EOPNOTSUPP; 380 381 rdev = wiphy_to_dev(wdev->wiphy); 382 383 if (wdev->iftype != NL80211_IFTYPE_STATION) 384 return -EINVAL; 385 386 if (mlme->addr.sa_family != ARPHRD_ETHER) 387 return -EINVAL; 388 389 wdev_lock(wdev); 390 switch (mlme->cmd) { 391 case IW_MLME_DEAUTH: 392 case IW_MLME_DISASSOC: 393 err = __cfg80211_disconnect(rdev, dev, mlme->reason_code, 394 true); 395 break; 396 default: 397 err = -EOPNOTSUPP; 398 break; 399 } 400 wdev_unlock(wdev); 401 402 return err; 403 } 404 EXPORT_SYMBOL_GPL(cfg80211_wext_siwmlme); 405