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