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