Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1 | /* |
| 2 | * mac80211 configuration hooks for cfg80211 |
| 3 | * |
Jouni Malinen | 026331c | 2010-02-15 12:53:10 +0200 | [diff] [blame] | 4 | * Copyright 2006-2010 Johannes Berg <johannes@sipsolutions.net> |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 5 | * Copyright 2013-2015 Intel Mobile Communications GmbH |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 6 | * |
| 7 | * This file is GPLv2 as found in COPYING. |
| 8 | */ |
| 9 | |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 10 | #include <linux/ieee80211.h> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 11 | #include <linux/nl80211.h> |
| 12 | #include <linux/rtnetlink.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 13 | #include <linux/slab.h> |
Eric W. Biederman | 881d966 | 2007-09-17 11:56:21 -0700 | [diff] [blame] | 14 | #include <net/net_namespace.h> |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 15 | #include <linux/rcupdate.h> |
Arik Nemtsov | dfe018b | 2011-09-28 14:12:52 +0300 | [diff] [blame] | 16 | #include <linux/if_ether.h> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 17 | #include <net/cfg80211.h> |
| 18 | #include "ieee80211_i.h" |
Johannes Berg | 2448798 | 2009-04-23 18:52:52 +0200 | [diff] [blame] | 19 | #include "driver-ops.h" |
Johannes Berg | 2c8dccc | 2008-04-08 15:14:40 -0400 | [diff] [blame] | 20 | #include "rate.h" |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 21 | #include "mesh.h" |
Johannes Berg | 02219b3 | 2014-10-07 10:38:50 +0300 | [diff] [blame] | 22 | #include "wme.h" |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 23 | |
Johannes Berg | 552bff0 | 2012-09-19 09:26:06 +0200 | [diff] [blame] | 24 | static struct wireless_dev *ieee80211_add_iface(struct wiphy *wiphy, |
| 25 | const char *name, |
Tom Gundersen | 6bab2e19 | 2015-03-18 11:13:39 +0100 | [diff] [blame] | 26 | unsigned char name_assign_type, |
Johannes Berg | 84efbb8 | 2012-06-16 00:00:26 +0200 | [diff] [blame] | 27 | enum nl80211_iftype type, |
| 28 | u32 *flags, |
| 29 | struct vif_params *params) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 30 | { |
| 31 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 84efbb8 | 2012-06-16 00:00:26 +0200 | [diff] [blame] | 32 | struct wireless_dev *wdev; |
Michael Wu | 8cc9a73 | 2008-01-31 19:48:23 +0100 | [diff] [blame] | 33 | struct ieee80211_sub_if_data *sdata; |
| 34 | int err; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 35 | |
Tom Gundersen | 6bab2e19 | 2015-03-18 11:13:39 +0100 | [diff] [blame] | 36 | err = ieee80211_if_add(local, name, name_assign_type, &wdev, type, params); |
Johannes Berg | f9e10ce | 2010-12-03 09:20:42 +0100 | [diff] [blame] | 37 | if (err) |
| 38 | return ERR_PTR(err); |
Michael Wu | 8cc9a73 | 2008-01-31 19:48:23 +0100 | [diff] [blame] | 39 | |
Johannes Berg | f9e10ce | 2010-12-03 09:20:42 +0100 | [diff] [blame] | 40 | if (type == NL80211_IFTYPE_MONITOR && flags) { |
Johannes Berg | 84efbb8 | 2012-06-16 00:00:26 +0200 | [diff] [blame] | 41 | sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Johannes Berg | f9e10ce | 2010-12-03 09:20:42 +0100 | [diff] [blame] | 42 | sdata->u.mntr_flags = *flags; |
| 43 | } |
| 44 | |
Johannes Berg | 84efbb8 | 2012-06-16 00:00:26 +0200 | [diff] [blame] | 45 | return wdev; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 46 | } |
| 47 | |
Johannes Berg | 84efbb8 | 2012-06-16 00:00:26 +0200 | [diff] [blame] | 48 | static int ieee80211_del_iface(struct wiphy *wiphy, struct wireless_dev *wdev) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 49 | { |
Johannes Berg | 84efbb8 | 2012-06-16 00:00:26 +0200 | [diff] [blame] | 50 | ieee80211_if_remove(IEEE80211_WDEV_TO_SUB_IF(wdev)); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 51 | |
Johannes Berg | 7563652 | 2008-07-09 14:40:35 +0200 | [diff] [blame] | 52 | return 0; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 53 | } |
| 54 | |
Johannes Berg | e36d56b | 2009-06-09 21:04:43 +0200 | [diff] [blame] | 55 | static int ieee80211_change_iface(struct wiphy *wiphy, |
| 56 | struct net_device *dev, |
Luis Carlos Cobo | 2ec600d | 2008-02-23 15:17:06 +0100 | [diff] [blame] | 57 | enum nl80211_iftype type, u32 *flags, |
| 58 | struct vif_params *params) |
Johannes Berg | 42613db | 2007-09-28 21:52:27 +0200 | [diff] [blame] | 59 | { |
Johannes Berg | 9607e6b | 2009-12-23 13:15:31 +0100 | [diff] [blame] | 60 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Johannes Berg | f3947e2 | 2008-07-09 14:40:36 +0200 | [diff] [blame] | 61 | int ret; |
Johannes Berg | 42613db | 2007-09-28 21:52:27 +0200 | [diff] [blame] | 62 | |
Johannes Berg | 05c914f | 2008-09-11 00:01:58 +0200 | [diff] [blame] | 63 | ret = ieee80211_if_change_type(sdata, type); |
Johannes Berg | f3947e2 | 2008-07-09 14:40:36 +0200 | [diff] [blame] | 64 | if (ret) |
| 65 | return ret; |
Johannes Berg | 42613db | 2007-09-28 21:52:27 +0200 | [diff] [blame] | 66 | |
Johannes Berg | 9bc383d | 2009-11-19 11:55:19 +0100 | [diff] [blame] | 67 | if (type == NL80211_IFTYPE_AP_VLAN && |
| 68 | params && params->use_4addr == 0) |
Stephen Hemminger | a9b3cd7 | 2011-08-01 16:19:00 +0000 | [diff] [blame] | 69 | RCU_INIT_POINTER(sdata->u.vlan.sta, NULL); |
Johannes Berg | 9bc383d | 2009-11-19 11:55:19 +0100 | [diff] [blame] | 70 | else if (type == NL80211_IFTYPE_STATION && |
| 71 | params && params->use_4addr >= 0) |
| 72 | sdata->u.mgd.use_4addr = params->use_4addr; |
| 73 | |
Christian Lamparter | 85416a4 | 2010-10-02 13:17:07 +0200 | [diff] [blame] | 74 | if (sdata->vif.type == NL80211_IFTYPE_MONITOR && flags) { |
| 75 | struct ieee80211_local *local = sdata->local; |
| 76 | |
| 77 | if (ieee80211_sdata_running(sdata)) { |
Felix Fietkau | 31eba5b | 2013-05-28 13:01:53 +0200 | [diff] [blame] | 78 | u32 mask = MONITOR_FLAG_COOK_FRAMES | |
| 79 | MONITOR_FLAG_ACTIVE; |
| 80 | |
Christian Lamparter | 85416a4 | 2010-10-02 13:17:07 +0200 | [diff] [blame] | 81 | /* |
Felix Fietkau | 31eba5b | 2013-05-28 13:01:53 +0200 | [diff] [blame] | 82 | * Prohibit MONITOR_FLAG_COOK_FRAMES and |
| 83 | * MONITOR_FLAG_ACTIVE to be changed while the |
| 84 | * interface is up. |
Christian Lamparter | 85416a4 | 2010-10-02 13:17:07 +0200 | [diff] [blame] | 85 | * Else we would need to add a lot of cruft |
| 86 | * to update everything: |
| 87 | * cooked_mntrs, monitor and all fif_* counters |
| 88 | * reconfigure hardware |
| 89 | */ |
Felix Fietkau | 31eba5b | 2013-05-28 13:01:53 +0200 | [diff] [blame] | 90 | if ((*flags & mask) != (sdata->u.mntr_flags & mask)) |
Christian Lamparter | 85416a4 | 2010-10-02 13:17:07 +0200 | [diff] [blame] | 91 | return -EBUSY; |
| 92 | |
| 93 | ieee80211_adjust_monitor_flags(sdata, -1); |
| 94 | sdata->u.mntr_flags = *flags; |
| 95 | ieee80211_adjust_monitor_flags(sdata, 1); |
| 96 | |
| 97 | ieee80211_configure_filter(local); |
| 98 | } else { |
| 99 | /* |
| 100 | * Because the interface is down, ieee80211_do_stop |
| 101 | * and ieee80211_do_open take care of "everything" |
| 102 | * mentioned in the comment above. |
| 103 | */ |
| 104 | sdata->u.mntr_flags = *flags; |
| 105 | } |
| 106 | } |
Felix Fietkau | f7917af | 2010-04-27 00:26:34 +0200 | [diff] [blame] | 107 | |
Johannes Berg | 42613db | 2007-09-28 21:52:27 +0200 | [diff] [blame] | 108 | return 0; |
| 109 | } |
| 110 | |
Johannes Berg | f142c6b | 2012-06-18 20:07:15 +0200 | [diff] [blame] | 111 | static int ieee80211_start_p2p_device(struct wiphy *wiphy, |
| 112 | struct wireless_dev *wdev) |
| 113 | { |
Luciano Coelho | b6a5501 | 2014-02-27 11:07:21 +0200 | [diff] [blame] | 114 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
| 115 | int ret; |
| 116 | |
| 117 | mutex_lock(&sdata->local->chanctx_mtx); |
| 118 | ret = ieee80211_check_combinations(sdata, NULL, 0, 0); |
| 119 | mutex_unlock(&sdata->local->chanctx_mtx); |
| 120 | if (ret < 0) |
| 121 | return ret; |
| 122 | |
Johannes Berg | f142c6b | 2012-06-18 20:07:15 +0200 | [diff] [blame] | 123 | return ieee80211_do_open(wdev, true); |
| 124 | } |
| 125 | |
| 126 | static void ieee80211_stop_p2p_device(struct wiphy *wiphy, |
| 127 | struct wireless_dev *wdev) |
| 128 | { |
| 129 | ieee80211_sdata_stop(IEEE80211_WDEV_TO_SUB_IF(wdev)); |
| 130 | } |
| 131 | |
Simon Wunderlich | b53be79 | 2011-11-18 14:20:44 +0100 | [diff] [blame] | 132 | static int ieee80211_set_noack_map(struct wiphy *wiphy, |
| 133 | struct net_device *dev, |
| 134 | u16 noack_map) |
| 135 | { |
| 136 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 137 | |
| 138 | sdata->noack_map = noack_map; |
Johannes Berg | 17c18bf | 2015-03-21 15:25:43 +0100 | [diff] [blame] | 139 | |
| 140 | ieee80211_check_fast_xmit_iface(sdata); |
| 141 | |
Simon Wunderlich | b53be79 | 2011-11-18 14:20:44 +0100 | [diff] [blame] | 142 | return 0; |
| 143 | } |
| 144 | |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 145 | static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | e31b821 | 2010-10-05 19:39:30 +0200 | [diff] [blame] | 146 | u8 key_idx, bool pairwise, const u8 *mac_addr, |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 147 | struct key_params *params) |
| 148 | { |
Johannes Berg | 26a5845 | 2010-08-27 12:35:55 +0200 | [diff] [blame] | 149 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 150 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 151 | struct sta_info *sta = NULL; |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 152 | const struct ieee80211_cipher_scheme *cs = NULL; |
Johannes Berg | db4d116 | 2008-02-25 16:27:45 +0100 | [diff] [blame] | 153 | struct ieee80211_key *key; |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 154 | int err; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 155 | |
Johannes Berg | 26a5845 | 2010-08-27 12:35:55 +0200 | [diff] [blame] | 156 | if (!ieee80211_sdata_running(sdata)) |
Johannes Berg | ad0e2b5 | 2010-06-01 10:19:19 +0200 | [diff] [blame] | 157 | return -ENETDOWN; |
| 158 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 159 | /* reject WEP and TKIP keys if WEP failed to initialize */ |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 160 | switch (params->cipher) { |
| 161 | case WLAN_CIPHER_SUITE_WEP40: |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 162 | case WLAN_CIPHER_SUITE_TKIP: |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 163 | case WLAN_CIPHER_SUITE_WEP104: |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 164 | if (IS_ERR(local->wep_tx_tfm)) |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 165 | return -EINVAL; |
Jouni Malinen | 3cfcf6ac | 2009-01-08 13:32:02 +0200 | [diff] [blame] | 166 | break; |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 167 | case WLAN_CIPHER_SUITE_CCMP: |
Jouni Malinen | 2b2ba0d | 2015-01-24 19:52:07 +0200 | [diff] [blame] | 168 | case WLAN_CIPHER_SUITE_CCMP_256: |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 169 | case WLAN_CIPHER_SUITE_AES_CMAC: |
Jouni Malinen | 56c52da | 2015-01-24 19:52:08 +0200 | [diff] [blame] | 170 | case WLAN_CIPHER_SUITE_BIP_CMAC_256: |
Jouni Malinen | 8ade538 | 2015-01-24 19:52:09 +0200 | [diff] [blame] | 171 | case WLAN_CIPHER_SUITE_BIP_GMAC_128: |
| 172 | case WLAN_CIPHER_SUITE_BIP_GMAC_256: |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 173 | case WLAN_CIPHER_SUITE_GCMP: |
Jouni Malinen | 00b9cfa | 2015-01-24 19:52:06 +0200 | [diff] [blame] | 174 | case WLAN_CIPHER_SUITE_GCMP_256: |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 175 | break; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 176 | default: |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 177 | cs = ieee80211_cs_get(local, params->cipher, sdata->vif.type); |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 178 | break; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 179 | } |
| 180 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 181 | key = ieee80211_key_alloc(params->cipher, key_idx, params->key_len, |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 182 | params->key, params->seq_len, params->seq, |
| 183 | cs); |
Ben Hutchings | 1ac62ba | 2010-08-01 17:37:03 +0100 | [diff] [blame] | 184 | if (IS_ERR(key)) |
| 185 | return PTR_ERR(key); |
Johannes Berg | db4d116 | 2008-02-25 16:27:45 +0100 | [diff] [blame] | 186 | |
Johannes Berg | e31b821 | 2010-10-05 19:39:30 +0200 | [diff] [blame] | 187 | if (pairwise) |
| 188 | key->conf.flags |= IEEE80211_KEY_FLAG_PAIRWISE; |
| 189 | |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 190 | mutex_lock(&local->sta_mtx); |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 191 | |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 192 | if (mac_addr) { |
Thomas Pedersen | ff973af | 2011-05-03 16:57:12 -0700 | [diff] [blame] | 193 | if (ieee80211_vif_is_mesh(&sdata->vif)) |
| 194 | sta = sta_info_get(sdata, mac_addr); |
| 195 | else |
| 196 | sta = sta_info_get_bss(sdata, mac_addr); |
Johannes Berg | 1626e0f | 2013-01-11 14:34:25 +0100 | [diff] [blame] | 197 | /* |
| 198 | * The ASSOC test makes sure the driver is ready to |
| 199 | * receive the key. When wpa_supplicant has roamed |
| 200 | * using FT, it attempts to set the key before |
| 201 | * association has completed, this rejects that attempt |
Stephen Hemminger | d070f91 | 2014-10-29 22:55:58 -0700 | [diff] [blame] | 202 | * so it will set the key again after association. |
Johannes Berg | 1626e0f | 2013-01-11 14:34:25 +0100 | [diff] [blame] | 203 | * |
| 204 | * TODO: accept the key if we have a station entry and |
| 205 | * add it to the device after the station. |
| 206 | */ |
| 207 | if (!sta || !test_sta_flag(sta, WLAN_STA_ASSOC)) { |
Johannes Berg | 79cf2df | 2013-03-06 22:53:52 +0100 | [diff] [blame] | 208 | ieee80211_key_free_unused(key); |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 209 | err = -ENOENT; |
| 210 | goto out_unlock; |
Johannes Berg | db4d116 | 2008-02-25 16:27:45 +0100 | [diff] [blame] | 211 | } |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 212 | } |
| 213 | |
Johannes Berg | e548c49 | 2012-09-04 17:08:23 +0200 | [diff] [blame] | 214 | switch (sdata->vif.type) { |
| 215 | case NL80211_IFTYPE_STATION: |
| 216 | if (sdata->u.mgd.mfp != IEEE80211_MFP_DISABLED) |
| 217 | key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT; |
| 218 | break; |
| 219 | case NL80211_IFTYPE_AP: |
| 220 | case NL80211_IFTYPE_AP_VLAN: |
| 221 | /* Keys without a station are used for TX only */ |
| 222 | if (key->sta && test_sta_flag(key->sta, WLAN_STA_MFP)) |
| 223 | key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT; |
| 224 | break; |
| 225 | case NL80211_IFTYPE_ADHOC: |
| 226 | /* no MFP (yet) */ |
| 227 | break; |
| 228 | case NL80211_IFTYPE_MESH_POINT: |
| 229 | #ifdef CONFIG_MAC80211_MESH |
| 230 | if (sdata->u.mesh.security != IEEE80211_MESH_SEC_NONE) |
| 231 | key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT; |
| 232 | break; |
| 233 | #endif |
| 234 | case NL80211_IFTYPE_WDS: |
| 235 | case NL80211_IFTYPE_MONITOR: |
| 236 | case NL80211_IFTYPE_P2P_DEVICE: |
| 237 | case NL80211_IFTYPE_UNSPECIFIED: |
| 238 | case NUM_NL80211_IFTYPES: |
| 239 | case NL80211_IFTYPE_P2P_CLIENT: |
| 240 | case NL80211_IFTYPE_P2P_GO: |
Rostislav Lisovy | 6e0bd6c | 2014-11-03 10:33:18 +0100 | [diff] [blame] | 241 | case NL80211_IFTYPE_OCB: |
Johannes Berg | e548c49 | 2012-09-04 17:08:23 +0200 | [diff] [blame] | 242 | /* shouldn't happen */ |
| 243 | WARN_ON_ONCE(1); |
| 244 | break; |
| 245 | } |
| 246 | |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 247 | if (sta) |
| 248 | sta->cipher_scheme = cs; |
| 249 | |
Johannes Berg | 3ffc2a9 | 2010-08-27 14:26:52 +0300 | [diff] [blame] | 250 | err = ieee80211_key_link(key, sdata, sta); |
Johannes Berg | db4d116 | 2008-02-25 16:27:45 +0100 | [diff] [blame] | 251 | |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 252 | out_unlock: |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 253 | mutex_unlock(&local->sta_mtx); |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 254 | |
| 255 | return err; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 256 | } |
| 257 | |
| 258 | static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | e31b821 | 2010-10-05 19:39:30 +0200 | [diff] [blame] | 259 | u8 key_idx, bool pairwise, const u8 *mac_addr) |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 260 | { |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 261 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 262 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 263 | struct sta_info *sta; |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 264 | struct ieee80211_key *key = NULL; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 265 | int ret; |
| 266 | |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 267 | mutex_lock(&local->sta_mtx); |
| 268 | mutex_lock(&local->key_mtx); |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 269 | |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 270 | if (mac_addr) { |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 271 | ret = -ENOENT; |
| 272 | |
Felix Fietkau | 0e5ded5 | 2010-01-08 18:10:58 +0100 | [diff] [blame] | 273 | sta = sta_info_get_bss(sdata, mac_addr); |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 274 | if (!sta) |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 275 | goto out_unlock; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 276 | |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 277 | if (pairwise) |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 278 | key = key_mtx_dereference(local, sta->ptk[key_idx]); |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 279 | else |
Johannes Berg | 40b275b | 2011-05-13 14:15:49 +0200 | [diff] [blame] | 280 | key = key_mtx_dereference(local, sta->gtk[key_idx]); |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 281 | } else |
Johannes Berg | 40b275b | 2011-05-13 14:15:49 +0200 | [diff] [blame] | 282 | key = key_mtx_dereference(local, sdata->keys[key_idx]); |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 283 | |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 284 | if (!key) { |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 285 | ret = -ENOENT; |
| 286 | goto out_unlock; |
| 287 | } |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 288 | |
Johannes Berg | 3b8d9c2 | 2013-03-06 22:58:23 +0100 | [diff] [blame] | 289 | ieee80211_key_free(key, true); |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 290 | |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 291 | ret = 0; |
| 292 | out_unlock: |
Johannes Berg | 5c0c364 | 2011-05-12 14:31:49 +0200 | [diff] [blame] | 293 | mutex_unlock(&local->key_mtx); |
| 294 | mutex_unlock(&local->sta_mtx); |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 295 | |
| 296 | return ret; |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 297 | } |
| 298 | |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 299 | static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | e31b821 | 2010-10-05 19:39:30 +0200 | [diff] [blame] | 300 | u8 key_idx, bool pairwise, const u8 *mac_addr, |
| 301 | void *cookie, |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 302 | void (*callback)(void *cookie, |
| 303 | struct key_params *params)) |
| 304 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 305 | struct ieee80211_sub_if_data *sdata; |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 306 | struct sta_info *sta = NULL; |
| 307 | u8 seq[6] = {0}; |
| 308 | struct key_params params; |
Johannes Berg | e31b821 | 2010-10-05 19:39:30 +0200 | [diff] [blame] | 309 | struct ieee80211_key *key = NULL; |
Johannes Berg | aba83a0b | 2011-07-06 21:59:39 +0200 | [diff] [blame] | 310 | u64 pn64; |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 311 | u32 iv32; |
| 312 | u16 iv16; |
| 313 | int err = -ENOENT; |
Johannes Berg | 9352c19 | 2015-04-20 18:12:41 +0200 | [diff] [blame] | 314 | struct ieee80211_key_seq kseq = {}; |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 315 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 316 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 317 | |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 318 | rcu_read_lock(); |
| 319 | |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 320 | if (mac_addr) { |
Felix Fietkau | 0e5ded5 | 2010-01-08 18:10:58 +0100 | [diff] [blame] | 321 | sta = sta_info_get_bss(sdata, mac_addr); |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 322 | if (!sta) |
| 323 | goto out; |
| 324 | |
Max Stepanov | 354e159 | 2013-12-08 13:30:52 +0200 | [diff] [blame] | 325 | if (pairwise && key_idx < NUM_DEFAULT_KEYS) |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 326 | key = rcu_dereference(sta->ptk[key_idx]); |
Max Stepanov | 31f1f4e | 2013-12-08 13:31:29 +0200 | [diff] [blame] | 327 | else if (!pairwise && |
| 328 | key_idx < NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS) |
Johannes Berg | a3836e0 | 2011-05-12 15:11:37 +0200 | [diff] [blame] | 329 | key = rcu_dereference(sta->gtk[key_idx]); |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 330 | } else |
Johannes Berg | a3836e0 | 2011-05-12 15:11:37 +0200 | [diff] [blame] | 331 | key = rcu_dereference(sdata->keys[key_idx]); |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 332 | |
| 333 | if (!key) |
| 334 | goto out; |
| 335 | |
| 336 | memset(¶ms, 0, sizeof(params)); |
| 337 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 338 | params.cipher = key->conf.cipher; |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 339 | |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 340 | switch (key->conf.cipher) { |
| 341 | case WLAN_CIPHER_SUITE_TKIP: |
Harvey Harrison | b0f76b3 | 2008-05-14 16:26:19 -0700 | [diff] [blame] | 342 | iv32 = key->u.tkip.tx.iv32; |
| 343 | iv16 = key->u.tkip.tx.iv16; |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 344 | |
Johannes Berg | 9352c19 | 2015-04-20 18:12:41 +0200 | [diff] [blame] | 345 | if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE && |
| 346 | !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) { |
| 347 | drv_get_key_seq(sdata->local, key, &kseq); |
| 348 | iv32 = kseq.tkip.iv32; |
| 349 | iv16 = kseq.tkip.iv16; |
| 350 | } |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 351 | |
| 352 | seq[0] = iv16 & 0xff; |
| 353 | seq[1] = (iv16 >> 8) & 0xff; |
| 354 | seq[2] = iv32 & 0xff; |
| 355 | seq[3] = (iv32 >> 8) & 0xff; |
| 356 | seq[4] = (iv32 >> 16) & 0xff; |
| 357 | seq[5] = (iv32 >> 24) & 0xff; |
| 358 | params.seq = seq; |
| 359 | params.seq_len = 6; |
| 360 | break; |
Johannes Berg | 97359d1 | 2010-08-10 09:46:38 +0200 | [diff] [blame] | 361 | case WLAN_CIPHER_SUITE_CCMP: |
Jouni Malinen | 2b2ba0d | 2015-01-24 19:52:07 +0200 | [diff] [blame] | 362 | case WLAN_CIPHER_SUITE_CCMP_256: |
Johannes Berg | db388a5 | 2015-06-01 15:36:51 +0200 | [diff] [blame] | 363 | case WLAN_CIPHER_SUITE_AES_CMAC: |
| 364 | case WLAN_CIPHER_SUITE_BIP_CMAC_256: |
| 365 | BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) != |
| 366 | offsetof(typeof(kseq), aes_cmac)); |
| 367 | case WLAN_CIPHER_SUITE_BIP_GMAC_128: |
| 368 | case WLAN_CIPHER_SUITE_BIP_GMAC_256: |
| 369 | BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) != |
| 370 | offsetof(typeof(kseq), aes_gmac)); |
| 371 | case WLAN_CIPHER_SUITE_GCMP: |
| 372 | case WLAN_CIPHER_SUITE_GCMP_256: |
| 373 | BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) != |
| 374 | offsetof(typeof(kseq), gcmp)); |
| 375 | |
Johannes Berg | 9352c19 | 2015-04-20 18:12:41 +0200 | [diff] [blame] | 376 | if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE && |
| 377 | !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) { |
| 378 | drv_get_key_seq(sdata->local, key, &kseq); |
| 379 | memcpy(seq, kseq.ccmp.pn, 6); |
| 380 | } else { |
Johannes Berg | db388a5 | 2015-06-01 15:36:51 +0200 | [diff] [blame] | 381 | pn64 = atomic64_read(&key->conf.tx_pn); |
Johannes Berg | 9352c19 | 2015-04-20 18:12:41 +0200 | [diff] [blame] | 382 | seq[0] = pn64; |
| 383 | seq[1] = pn64 >> 8; |
| 384 | seq[2] = pn64 >> 16; |
| 385 | seq[3] = pn64 >> 24; |
| 386 | seq[4] = pn64 >> 32; |
| 387 | seq[5] = pn64 >> 40; |
| 388 | } |
Jouni Malinen | 00b9cfa | 2015-01-24 19:52:06 +0200 | [diff] [blame] | 389 | params.seq = seq; |
| 390 | params.seq_len = 6; |
| 391 | break; |
Johannes Berg | a31cf1c | 2015-04-20 18:21:58 +0200 | [diff] [blame] | 392 | default: |
| 393 | if (!(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE)) |
| 394 | break; |
| 395 | if (WARN_ON(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) |
| 396 | break; |
| 397 | drv_get_key_seq(sdata->local, key, &kseq); |
| 398 | params.seq = kseq.hw.seq; |
| 399 | params.seq_len = kseq.hw.seq_len; |
| 400 | break; |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 401 | } |
| 402 | |
| 403 | params.key = key->conf.key; |
| 404 | params.key_len = key->conf.keylen; |
| 405 | |
| 406 | callback(cookie, ¶ms); |
| 407 | err = 0; |
| 408 | |
| 409 | out: |
Johannes Berg | 3b96766 | 2008-04-08 17:56:52 +0200 | [diff] [blame] | 410 | rcu_read_unlock(); |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 411 | return err; |
| 412 | } |
| 413 | |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 414 | static int ieee80211_config_default_key(struct wiphy *wiphy, |
| 415 | struct net_device *dev, |
Johannes Berg | dbd2fd6 | 2010-12-09 19:58:59 +0100 | [diff] [blame] | 416 | u8 key_idx, bool uni, |
| 417 | bool multi) |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 418 | { |
Johannes Berg | ad0e2b5 | 2010-06-01 10:19:19 +0200 | [diff] [blame] | 419 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 420 | |
Johannes Berg | f7e0104 | 2010-12-09 19:49:02 +0100 | [diff] [blame] | 421 | ieee80211_set_default_key(sdata, key_idx, uni, multi); |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 422 | |
| 423 | return 0; |
| 424 | } |
| 425 | |
Jouni Malinen | 3cfcf6ac | 2009-01-08 13:32:02 +0200 | [diff] [blame] | 426 | static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy, |
| 427 | struct net_device *dev, |
| 428 | u8 key_idx) |
| 429 | { |
Johannes Berg | 66c5242 | 2010-07-22 13:58:51 +0200 | [diff] [blame] | 430 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Jouni Malinen | 3cfcf6ac | 2009-01-08 13:32:02 +0200 | [diff] [blame] | 431 | |
Jouni Malinen | 3cfcf6ac | 2009-01-08 13:32:02 +0200 | [diff] [blame] | 432 | ieee80211_set_default_mgmt_key(sdata, key_idx); |
| 433 | |
Jouni Malinen | 3cfcf6ac | 2009-01-08 13:32:02 +0200 | [diff] [blame] | 434 | return 0; |
| 435 | } |
| 436 | |
Thomas Pedersen | 6b62bf3 | 2012-03-05 15:31:48 -0800 | [diff] [blame] | 437 | void sta_set_rate_info_tx(struct sta_info *sta, |
| 438 | const struct ieee80211_tx_rate *rate, |
| 439 | struct rate_info *rinfo) |
| 440 | { |
| 441 | rinfo->flags = 0; |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 442 | if (rate->flags & IEEE80211_TX_RC_MCS) { |
Thomas Pedersen | 6b62bf3 | 2012-03-05 15:31:48 -0800 | [diff] [blame] | 443 | rinfo->flags |= RATE_INFO_FLAGS_MCS; |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 444 | rinfo->mcs = rate->idx; |
| 445 | } else if (rate->flags & IEEE80211_TX_RC_VHT_MCS) { |
| 446 | rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS; |
| 447 | rinfo->mcs = ieee80211_rate_get_vht_mcs(rate); |
| 448 | rinfo->nss = ieee80211_rate_get_vht_nss(rate); |
| 449 | } else { |
| 450 | struct ieee80211_supported_band *sband; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 451 | int shift = ieee80211_vif_get_shift(&sta->sdata->vif); |
| 452 | u16 brate; |
| 453 | |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 454 | sband = sta->local->hw.wiphy->bands[ |
| 455 | ieee80211_get_sdata_band(sta->sdata)]; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 456 | brate = sband->bitrates[rate->idx].bitrate; |
| 457 | rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift); |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 458 | } |
Thomas Pedersen | 6b62bf3 | 2012-03-05 15:31:48 -0800 | [diff] [blame] | 459 | if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH) |
Johannes Berg | b51f3be | 2015-01-15 16:14:02 +0100 | [diff] [blame] | 460 | rinfo->bw = RATE_INFO_BW_40; |
| 461 | else if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH) |
| 462 | rinfo->bw = RATE_INFO_BW_80; |
| 463 | else if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH) |
| 464 | rinfo->bw = RATE_INFO_BW_160; |
| 465 | else |
| 466 | rinfo->bw = RATE_INFO_BW_20; |
Thomas Pedersen | 6b62bf3 | 2012-03-05 15:31:48 -0800 | [diff] [blame] | 467 | if (rate->flags & IEEE80211_TX_RC_SHORT_GI) |
| 468 | rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI; |
Thomas Pedersen | 6b62bf3 | 2012-03-05 15:31:48 -0800 | [diff] [blame] | 469 | } |
| 470 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 471 | static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 472 | int idx, u8 *mac, struct station_info *sinfo) |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 473 | { |
Johannes Berg | 3b53fde8 | 2009-11-16 12:00:37 +0100 | [diff] [blame] | 474 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Victor Goldenshtein | 66572cf | 2012-06-21 10:56:46 +0300 | [diff] [blame] | 475 | struct ieee80211_local *local = sdata->local; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 476 | struct sta_info *sta; |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 477 | int ret = -ENOENT; |
| 478 | |
Victor Goldenshtein | 66572cf | 2012-06-21 10:56:46 +0300 | [diff] [blame] | 479 | mutex_lock(&local->sta_mtx); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 480 | |
Johannes Berg | 3b53fde8 | 2009-11-16 12:00:37 +0100 | [diff] [blame] | 481 | sta = sta_info_get_by_idx(sdata, idx); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 482 | if (sta) { |
| 483 | ret = 0; |
Johannes Berg | 17741cd | 2008-09-11 00:02:02 +0200 | [diff] [blame] | 484 | memcpy(mac, sta->sta.addr, ETH_ALEN); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 485 | sta_set_sinfo(sta, sinfo); |
| 486 | } |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 487 | |
Victor Goldenshtein | 66572cf | 2012-06-21 10:56:46 +0300 | [diff] [blame] | 488 | mutex_unlock(&local->sta_mtx); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 489 | |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 490 | return ret; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 491 | } |
| 492 | |
Holger Schurig | 1289723 | 2010-04-19 10:23:57 +0200 | [diff] [blame] | 493 | static int ieee80211_dump_survey(struct wiphy *wiphy, struct net_device *dev, |
| 494 | int idx, struct survey_info *survey) |
| 495 | { |
| 496 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); |
| 497 | |
Holger Schurig | 1289723 | 2010-04-19 10:23:57 +0200 | [diff] [blame] | 498 | return drv_get_survey(local, idx, survey); |
| 499 | } |
| 500 | |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 501 | static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 502 | const u8 *mac, struct station_info *sinfo) |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 503 | { |
Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 504 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Victor Goldenshtein | 66572cf | 2012-06-21 10:56:46 +0300 | [diff] [blame] | 505 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 506 | struct sta_info *sta; |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 507 | int ret = -ENOENT; |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 508 | |
Victor Goldenshtein | 66572cf | 2012-06-21 10:56:46 +0300 | [diff] [blame] | 509 | mutex_lock(&local->sta_mtx); |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 510 | |
Felix Fietkau | 0e5ded5 | 2010-01-08 18:10:58 +0100 | [diff] [blame] | 511 | sta = sta_info_get_bss(sdata, mac); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 512 | if (sta) { |
| 513 | ret = 0; |
| 514 | sta_set_sinfo(sta, sinfo); |
| 515 | } |
| 516 | |
Victor Goldenshtein | 66572cf | 2012-06-21 10:56:46 +0300 | [diff] [blame] | 517 | mutex_unlock(&local->sta_mtx); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 518 | |
| 519 | return ret; |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 520 | } |
| 521 | |
Johannes Berg | e8c9bd5 | 2012-06-06 08:18:22 +0200 | [diff] [blame] | 522 | static int ieee80211_set_monitor_channel(struct wiphy *wiphy, |
Johannes Berg | 683b6d3 | 2012-11-08 21:25:48 +0100 | [diff] [blame] | 523 | struct cfg80211_chan_def *chandef) |
Johannes Berg | e8c9bd5 | 2012-06-06 08:18:22 +0200 | [diff] [blame] | 524 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 525 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 526 | struct ieee80211_sub_if_data *sdata; |
| 527 | int ret = 0; |
| 528 | |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 529 | if (cfg80211_chandef_identical(&local->monitor_chandef, chandef)) |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 530 | return 0; |
| 531 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 532 | mutex_lock(&local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 533 | mutex_lock(&local->iflist_mtx); |
| 534 | if (local->use_chanctx) { |
| 535 | sdata = rcu_dereference_protected( |
| 536 | local->monitor_sdata, |
| 537 | lockdep_is_held(&local->iflist_mtx)); |
| 538 | if (sdata) { |
| 539 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 540 | ret = ieee80211_vif_use_channel(sdata, chandef, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 541 | IEEE80211_CHANCTX_EXCLUSIVE); |
| 542 | } |
| 543 | } else if (local->open_count == local->monitors) { |
Karl Beldan | 675a0b0 | 2013-03-25 16:26:57 +0100 | [diff] [blame] | 544 | local->_oper_chandef = *chandef; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 545 | ieee80211_hw_config(local, 0); |
| 546 | } |
| 547 | |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 548 | if (ret == 0) |
| 549 | local->monitor_chandef = *chandef; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 550 | mutex_unlock(&local->iflist_mtx); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 551 | mutex_unlock(&local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 552 | |
| 553 | return ret; |
Johannes Berg | e8c9bd5 | 2012-06-06 08:18:22 +0200 | [diff] [blame] | 554 | } |
| 555 | |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 556 | static int ieee80211_set_probe_resp(struct ieee80211_sub_if_data *sdata, |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 557 | const u8 *resp, size_t resp_len, |
| 558 | const struct ieee80211_csa_settings *csa) |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 559 | { |
Eyal Shapira | aa7a008 | 2012-08-06 14:26:16 +0300 | [diff] [blame] | 560 | struct probe_resp *new, *old; |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 561 | |
| 562 | if (!resp || !resp_len) |
Sujith Manoharan | aba4e6f | 2012-08-22 14:21:07 +0530 | [diff] [blame] | 563 | return 1; |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 564 | |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 565 | old = sdata_dereference(sdata->u.ap.probe_resp, sdata); |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 566 | |
Eyal Shapira | aa7a008 | 2012-08-06 14:26:16 +0300 | [diff] [blame] | 567 | new = kzalloc(sizeof(struct probe_resp) + resp_len, GFP_KERNEL); |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 568 | if (!new) |
| 569 | return -ENOMEM; |
| 570 | |
Eyal Shapira | aa7a008 | 2012-08-06 14:26:16 +0300 | [diff] [blame] | 571 | new->len = resp_len; |
| 572 | memcpy(new->data, resp, resp_len); |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 573 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 574 | if (csa) |
| 575 | memcpy(new->csa_counter_offsets, csa->counter_offsets_presp, |
| 576 | csa->n_counter_offsets_presp * |
| 577 | sizeof(new->csa_counter_offsets[0])); |
| 578 | |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 579 | rcu_assign_pointer(sdata->u.ap.probe_resp, new); |
Eyal Shapira | aa7a008 | 2012-08-06 14:26:16 +0300 | [diff] [blame] | 580 | if (old) |
| 581 | kfree_rcu(old, rcu_head); |
Arik Nemtsov | 0294582 | 2011-11-10 11:28:57 +0200 | [diff] [blame] | 582 | |
| 583 | return 0; |
| 584 | } |
| 585 | |
Luciano Coelho | 0ae0796 | 2013-12-08 09:42:25 +0200 | [diff] [blame] | 586 | static int ieee80211_assign_beacon(struct ieee80211_sub_if_data *sdata, |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 587 | struct cfg80211_beacon_data *params, |
| 588 | const struct ieee80211_csa_settings *csa) |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 589 | { |
| 590 | struct beacon_data *new, *old; |
| 591 | int new_head_len, new_tail_len; |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 592 | int size, err; |
| 593 | u32 changed = BSS_CHANGED_BEACON; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 594 | |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 595 | old = sdata_dereference(sdata->u.ap.beacon, sdata); |
| 596 | |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 597 | |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 598 | /* Need to have a beacon head if we don't have one yet */ |
| 599 | if (!params->head && !old) |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 600 | return -EINVAL; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 601 | |
| 602 | /* new or old head? */ |
| 603 | if (params->head) |
| 604 | new_head_len = params->head_len; |
| 605 | else |
| 606 | new_head_len = old->head_len; |
| 607 | |
| 608 | /* new or old tail? */ |
| 609 | if (params->tail || !old) |
| 610 | /* params->tail_len will be zero for !params->tail */ |
| 611 | new_tail_len = params->tail_len; |
| 612 | else |
| 613 | new_tail_len = old->tail_len; |
| 614 | |
| 615 | size = sizeof(*new) + new_head_len + new_tail_len; |
| 616 | |
| 617 | new = kzalloc(size, GFP_KERNEL); |
| 618 | if (!new) |
| 619 | return -ENOMEM; |
| 620 | |
| 621 | /* start filling the new info now */ |
| 622 | |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 623 | /* |
| 624 | * pointers go into the block we allocated, |
| 625 | * memory is | beacon_data | head | tail | |
| 626 | */ |
| 627 | new->head = ((u8 *) new) + sizeof(*new); |
| 628 | new->tail = new->head + new_head_len; |
| 629 | new->head_len = new_head_len; |
| 630 | new->tail_len = new_tail_len; |
| 631 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 632 | if (csa) { |
| 633 | new->csa_current_counter = csa->count; |
| 634 | memcpy(new->csa_counter_offsets, csa->counter_offsets_beacon, |
| 635 | csa->n_counter_offsets_beacon * |
| 636 | sizeof(new->csa_counter_offsets[0])); |
| 637 | } |
| 638 | |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 639 | /* copy in head */ |
| 640 | if (params->head) |
| 641 | memcpy(new->head, params->head, new_head_len); |
| 642 | else |
| 643 | memcpy(new->head, old->head, new_head_len); |
| 644 | |
| 645 | /* copy in optional tail */ |
| 646 | if (params->tail) |
| 647 | memcpy(new->tail, params->tail, new_tail_len); |
| 648 | else |
| 649 | if (old) |
| 650 | memcpy(new->tail, old->tail, new_tail_len); |
| 651 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 652 | err = ieee80211_set_probe_resp(sdata, params->probe_resp, |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 653 | params->probe_resp_len, csa); |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 654 | if (err < 0) |
| 655 | return err; |
| 656 | if (err == 0) |
| 657 | changed |= BSS_CHANGED_AP_PROBE_RESP; |
Johannes Berg | 19885c4 | 2010-02-05 11:45:06 +0100 | [diff] [blame] | 658 | |
Eric Dumazet | cf778b0 | 2012-01-12 04:41:32 +0000 | [diff] [blame] | 659 | rcu_assign_pointer(sdata->u.ap.beacon, new); |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 660 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 661 | if (old) |
| 662 | kfree_rcu(old, rcu_head); |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 663 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 664 | return changed; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 665 | } |
| 666 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 667 | static int ieee80211_start_ap(struct wiphy *wiphy, struct net_device *dev, |
| 668 | struct cfg80211_ap_settings *params) |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 669 | { |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 670 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 671 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 672 | struct beacon_data *old; |
Johannes Berg | 665c93a | 2011-11-04 11:18:11 +0100 | [diff] [blame] | 673 | struct ieee80211_sub_if_data *vlan; |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 674 | u32 changed = BSS_CHANGED_BEACON_INT | |
| 675 | BSS_CHANGED_BEACON_ENABLED | |
| 676 | BSS_CHANGED_BEACON | |
Johannes Berg | 339afbf | 2012-11-14 15:21:17 +0100 | [diff] [blame] | 677 | BSS_CHANGED_SSID | |
Johannes Berg | 4bcc56b | 2014-11-13 11:23:53 +0100 | [diff] [blame] | 678 | BSS_CHANGED_P2P_PS | |
| 679 | BSS_CHANGED_TXPOWER; |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 680 | int err; |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 681 | |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 682 | old = sdata_dereference(sdata->u.ap.beacon, sdata); |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 683 | if (old) |
| 684 | return -EALREADY; |
| 685 | |
Eliad Peller | f699317 | 2014-09-10 14:07:35 +0300 | [diff] [blame] | 686 | switch (params->smps_mode) { |
| 687 | case NL80211_SMPS_OFF: |
| 688 | sdata->smps_mode = IEEE80211_SMPS_OFF; |
| 689 | break; |
| 690 | case NL80211_SMPS_STATIC: |
| 691 | sdata->smps_mode = IEEE80211_SMPS_STATIC; |
| 692 | break; |
| 693 | case NL80211_SMPS_DYNAMIC: |
| 694 | sdata->smps_mode = IEEE80211_SMPS_DYNAMIC; |
| 695 | break; |
| 696 | default: |
| 697 | return -EINVAL; |
| 698 | } |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 699 | sdata->needed_rx_chains = sdata->local->rx_chains; |
| 700 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 701 | mutex_lock(&local->mtx); |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 702 | err = ieee80211_vif_use_channel(sdata, ¶ms->chandef, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 703 | IEEE80211_CHANCTX_SHARED); |
Michal Kazior | 4e141da | 2014-03-05 13:14:08 +0100 | [diff] [blame] | 704 | if (!err) |
| 705 | ieee80211_vif_copy_chanctx_to_vlans(sdata, false); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 706 | mutex_unlock(&local->mtx); |
Johannes Berg | aa430da | 2012-05-16 23:50:18 +0200 | [diff] [blame] | 707 | if (err) |
| 708 | return err; |
| 709 | |
Johannes Berg | 665c93a | 2011-11-04 11:18:11 +0100 | [diff] [blame] | 710 | /* |
| 711 | * Apply control port protocol, this allows us to |
| 712 | * not encrypt dynamic WEP control frames. |
| 713 | */ |
| 714 | sdata->control_port_protocol = params->crypto.control_port_ethertype; |
| 715 | sdata->control_port_no_encrypt = params->crypto.control_port_no_encrypt; |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 716 | sdata->encrypt_headroom = ieee80211_cs_headroom(sdata->local, |
| 717 | ¶ms->crypto, |
| 718 | sdata->vif.type); |
| 719 | |
Johannes Berg | 665c93a | 2011-11-04 11:18:11 +0100 | [diff] [blame] | 720 | list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list) { |
| 721 | vlan->control_port_protocol = |
| 722 | params->crypto.control_port_ethertype; |
| 723 | vlan->control_port_no_encrypt = |
| 724 | params->crypto.control_port_no_encrypt; |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 725 | vlan->encrypt_headroom = |
| 726 | ieee80211_cs_headroom(sdata->local, |
| 727 | ¶ms->crypto, |
| 728 | vlan->vif.type); |
Johannes Berg | 665c93a | 2011-11-04 11:18:11 +0100 | [diff] [blame] | 729 | } |
| 730 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 731 | sdata->vif.bss_conf.beacon_int = params->beacon_interval; |
| 732 | sdata->vif.bss_conf.dtim_period = params->dtim_period; |
Johannes Berg | d6a8322 | 2012-12-14 14:06:28 +0100 | [diff] [blame] | 733 | sdata->vif.bss_conf.enable_beacon = true; |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 734 | |
| 735 | sdata->vif.bss_conf.ssid_len = params->ssid_len; |
| 736 | if (params->ssid_len) |
| 737 | memcpy(sdata->vif.bss_conf.ssid, params->ssid, |
| 738 | params->ssid_len); |
| 739 | sdata->vif.bss_conf.hidden_ssid = |
| 740 | (params->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE); |
| 741 | |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 742 | memset(&sdata->vif.bss_conf.p2p_noa_attr, 0, |
| 743 | sizeof(sdata->vif.bss_conf.p2p_noa_attr)); |
| 744 | sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow = |
| 745 | params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK; |
| 746 | if (params->p2p_opp_ps) |
| 747 | sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |= |
| 748 | IEEE80211_P2P_OPPPS_ENABLE_BIT; |
Johannes Berg | 339afbf | 2012-11-14 15:21:17 +0100 | [diff] [blame] | 749 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 750 | err = ieee80211_assign_beacon(sdata, ¶ms->beacon, NULL); |
Emmanuel Grumbach | 0297ea1 | 2014-01-27 11:07:42 +0200 | [diff] [blame] | 751 | if (err < 0) { |
| 752 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 753 | return err; |
Emmanuel Grumbach | 0297ea1 | 2014-01-27 11:07:42 +0200 | [diff] [blame] | 754 | } |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 755 | changed |= err; |
| 756 | |
Johannes Berg | 1041638 | 2012-10-19 15:44:42 +0200 | [diff] [blame] | 757 | err = drv_start_ap(sdata->local, sdata); |
| 758 | if (err) { |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 759 | old = sdata_dereference(sdata->u.ap.beacon, sdata); |
| 760 | |
Johannes Berg | 1041638 | 2012-10-19 15:44:42 +0200 | [diff] [blame] | 761 | if (old) |
| 762 | kfree_rcu(old, rcu_head); |
| 763 | RCU_INIT_POINTER(sdata->u.ap.beacon, NULL); |
Emmanuel Grumbach | 0297ea1 | 2014-01-27 11:07:42 +0200 | [diff] [blame] | 764 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 1041638 | 2012-10-19 15:44:42 +0200 | [diff] [blame] | 765 | return err; |
| 766 | } |
| 767 | |
Thomas Pedersen | 057d5f4 | 2013-12-19 10:25:15 -0800 | [diff] [blame] | 768 | ieee80211_recalc_dtim(local, sdata); |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 769 | ieee80211_bss_info_change_notify(sdata, changed); |
| 770 | |
Johannes Berg | 3edaf3e | 2012-04-03 10:24:00 +0200 | [diff] [blame] | 771 | netif_carrier_on(dev); |
| 772 | list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list) |
| 773 | netif_carrier_on(vlan->dev); |
| 774 | |
Johannes Berg | 665c93a | 2011-11-04 11:18:11 +0100 | [diff] [blame] | 775 | return 0; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 776 | } |
| 777 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 778 | static int ieee80211_change_beacon(struct wiphy *wiphy, struct net_device *dev, |
| 779 | struct cfg80211_beacon_data *params) |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 780 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 781 | struct ieee80211_sub_if_data *sdata; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 782 | struct beacon_data *old; |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 783 | int err; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 784 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 785 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Michal Kazior | dbd7285 | 2014-01-29 07:56:21 +0100 | [diff] [blame] | 786 | sdata_assert_lock(sdata); |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 787 | |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 788 | /* don't allow changing the beacon while CSA is in place - offset |
| 789 | * of channel switch counter may change |
| 790 | */ |
| 791 | if (sdata->vif.csa_active) |
| 792 | return -EBUSY; |
| 793 | |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 794 | old = sdata_dereference(sdata->u.ap.beacon, sdata); |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 795 | if (!old) |
| 796 | return -ENOENT; |
| 797 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 798 | err = ieee80211_assign_beacon(sdata, params, NULL); |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 799 | if (err < 0) |
| 800 | return err; |
| 801 | ieee80211_bss_info_change_notify(sdata, err); |
| 802 | return 0; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 803 | } |
| 804 | |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 805 | static int ieee80211_stop_ap(struct wiphy *wiphy, struct net_device *dev) |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 806 | { |
Johannes Berg | 7b20b8e | 2012-10-25 19:02:42 +0200 | [diff] [blame] | 807 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 808 | struct ieee80211_sub_if_data *vlan; |
| 809 | struct ieee80211_local *local = sdata->local; |
| 810 | struct beacon_data *old_beacon; |
| 811 | struct probe_resp *old_probe_resp; |
Janusz Dziedzic | d2859df | 2013-11-06 13:55:51 +0100 | [diff] [blame] | 812 | struct cfg80211_chan_def chandef; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 813 | |
Michal Kazior | dbd7285 | 2014-01-29 07:56:21 +0100 | [diff] [blame] | 814 | sdata_assert_lock(sdata); |
| 815 | |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 816 | old_beacon = sdata_dereference(sdata->u.ap.beacon, sdata); |
Johannes Berg | 7b20b8e | 2012-10-25 19:02:42 +0200 | [diff] [blame] | 817 | if (!old_beacon) |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 818 | return -ENOENT; |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 819 | old_probe_resp = sdata_dereference(sdata->u.ap.probe_resp, sdata); |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 820 | |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 821 | /* abort any running channel switch */ |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 822 | mutex_lock(&local->mtx); |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 823 | sdata->vif.csa_active = false; |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 824 | if (sdata->csa_block_tx) { |
| 825 | ieee80211_wake_vif_queues(local, sdata, |
| 826 | IEEE80211_QUEUE_STOP_REASON_CSA); |
| 827 | sdata->csa_block_tx = false; |
| 828 | } |
| 829 | |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 830 | mutex_unlock(&local->mtx); |
| 831 | |
Simon Wunderlich | 1f3b8a2 | 2013-11-21 18:19:53 +0100 | [diff] [blame] | 832 | kfree(sdata->u.ap.next_beacon); |
| 833 | sdata->u.ap.next_beacon = NULL; |
| 834 | |
Johannes Berg | 7b20b8e | 2012-10-25 19:02:42 +0200 | [diff] [blame] | 835 | /* turn off carrier for this interface and dependent VLANs */ |
Johannes Berg | 3edaf3e | 2012-04-03 10:24:00 +0200 | [diff] [blame] | 836 | list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list) |
| 837 | netif_carrier_off(vlan->dev); |
| 838 | netif_carrier_off(dev); |
| 839 | |
Johannes Berg | 7b20b8e | 2012-10-25 19:02:42 +0200 | [diff] [blame] | 840 | /* remove beacon and probe response */ |
Stephen Hemminger | a9b3cd7 | 2011-08-01 16:19:00 +0000 | [diff] [blame] | 841 | RCU_INIT_POINTER(sdata->u.ap.beacon, NULL); |
Johannes Berg | 7b20b8e | 2012-10-25 19:02:42 +0200 | [diff] [blame] | 842 | RCU_INIT_POINTER(sdata->u.ap.probe_resp, NULL); |
| 843 | kfree_rcu(old_beacon, rcu_head); |
| 844 | if (old_probe_resp) |
| 845 | kfree_rcu(old_probe_resp, rcu_head); |
Emmanuel Grumbach | 8ffcc70 | 2014-01-23 14:28:16 +0200 | [diff] [blame] | 846 | sdata->u.ap.driver_smps_mode = IEEE80211_SMPS_OFF; |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 847 | |
Johannes Berg | e716251 | 2013-12-04 23:18:37 +0100 | [diff] [blame] | 848 | __sta_info_flush(sdata, true); |
Johannes Berg | 7907c7d | 2013-12-04 23:47:09 +0100 | [diff] [blame] | 849 | ieee80211_free_keys(sdata, true); |
Johannes Berg | 75de911 | 2012-12-14 14:56:03 +0100 | [diff] [blame] | 850 | |
Johannes Berg | d6a8322 | 2012-12-14 14:06:28 +0100 | [diff] [blame] | 851 | sdata->vif.bss_conf.enable_beacon = false; |
Marek Puzyniak | 0eabccd | 2013-04-10 13:47:45 +0200 | [diff] [blame] | 852 | sdata->vif.bss_conf.ssid_len = 0; |
Johannes Berg | d6a8322 | 2012-12-14 14:06:28 +0100 | [diff] [blame] | 853 | clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state); |
Johannes Berg | 2d0ddec | 2009-04-23 16:13:26 +0200 | [diff] [blame] | 854 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED); |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 855 | |
Simon Wunderlich | a6b368f | 2013-06-11 10:44:39 +0200 | [diff] [blame] | 856 | if (sdata->wdev.cac_started) { |
Janusz Dziedzic | d2859df | 2013-11-06 13:55:51 +0100 | [diff] [blame] | 857 | chandef = sdata->vif.bss_conf.chandef; |
Simon Wunderlich | a6b368f | 2013-06-11 10:44:39 +0200 | [diff] [blame] | 858 | cancel_delayed_work_sync(&sdata->dfs_cac_timer_work); |
Janusz Dziedzic | d2859df | 2013-11-06 13:55:51 +0100 | [diff] [blame] | 859 | cfg80211_cac_event(sdata->dev, &chandef, |
| 860 | NL80211_RADAR_CAC_ABORTED, |
Simon Wunderlich | a6b368f | 2013-06-11 10:44:39 +0200 | [diff] [blame] | 861 | GFP_KERNEL); |
| 862 | } |
| 863 | |
Johannes Berg | 1041638 | 2012-10-19 15:44:42 +0200 | [diff] [blame] | 864 | drv_stop_ap(sdata->local, sdata); |
| 865 | |
Johannes Berg | 7b20b8e | 2012-10-25 19:02:42 +0200 | [diff] [blame] | 866 | /* free all potentially still buffered bcast frames */ |
| 867 | local->total_ps_buffered -= skb_queue_len(&sdata->u.ap.ps.bc_buf); |
| 868 | skb_queue_purge(&sdata->u.ap.ps.bc_buf); |
| 869 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 870 | mutex_lock(&local->mtx); |
Michal Kazior | 4e141da | 2014-03-05 13:14:08 +0100 | [diff] [blame] | 871 | ieee80211_vif_copy_chanctx_to_vlans(sdata, true); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 872 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 873 | mutex_unlock(&local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 874 | |
Johannes Berg | 2d0ddec | 2009-04-23 16:13:26 +0200 | [diff] [blame] | 875 | return 0; |
Johannes Berg | 5dfdaf5 | 2007-12-19 02:03:33 +0100 | [diff] [blame] | 876 | } |
| 877 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 878 | /* Layer 2 Update frame (802.2 Type 1 LLC XID Update response) */ |
| 879 | struct iapp_layer2_update { |
| 880 | u8 da[ETH_ALEN]; /* broadcast */ |
| 881 | u8 sa[ETH_ALEN]; /* STA addr */ |
| 882 | __be16 len; /* 6 */ |
| 883 | u8 dsap; /* 0 */ |
| 884 | u8 ssap; /* 0 */ |
| 885 | u8 control; |
| 886 | u8 xid_info[3]; |
Eric Dumazet | bc10502 | 2010-06-03 03:21:52 -0700 | [diff] [blame] | 887 | } __packed; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 888 | |
| 889 | static void ieee80211_send_layer2_update(struct sta_info *sta) |
| 890 | { |
| 891 | struct iapp_layer2_update *msg; |
| 892 | struct sk_buff *skb; |
| 893 | |
| 894 | /* Send Level 2 Update Frame to update forwarding tables in layer 2 |
| 895 | * bridge devices */ |
| 896 | |
| 897 | skb = dev_alloc_skb(sizeof(*msg)); |
| 898 | if (!skb) |
| 899 | return; |
| 900 | msg = (struct iapp_layer2_update *)skb_put(skb, sizeof(*msg)); |
| 901 | |
| 902 | /* 802.2 Type 1 Logical Link Control (LLC) Exchange Identifier (XID) |
| 903 | * Update response frame; IEEE Std 802.2-1998, 5.4.1.2.1 */ |
| 904 | |
Johannes Berg | e83e654 | 2012-07-13 16:23:07 +0200 | [diff] [blame] | 905 | eth_broadcast_addr(msg->da); |
Johannes Berg | 17741cd | 2008-09-11 00:02:02 +0200 | [diff] [blame] | 906 | memcpy(msg->sa, sta->sta.addr, ETH_ALEN); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 907 | msg->len = htons(6); |
| 908 | msg->dsap = 0; |
| 909 | msg->ssap = 0x01; /* NULL LSAP, CR Bit: Response */ |
| 910 | msg->control = 0xaf; /* XID response lsb.1111F101. |
| 911 | * F=0 (no poll command; unsolicited frame) */ |
| 912 | msg->xid_info[0] = 0x81; /* XID format identifier */ |
| 913 | msg->xid_info[1] = 1; /* LLC types/classes: Type 1 LLC */ |
| 914 | msg->xid_info[2] = 0; /* XID sender's receive window size (RW) */ |
| 915 | |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 916 | skb->dev = sta->sdata->dev; |
| 917 | skb->protocol = eth_type_trans(skb, sta->sdata->dev); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 918 | memset(skb->cb, 0, sizeof(skb->cb)); |
John W. Linville | 06ee1c2 | 2010-07-19 11:52:59 -0400 | [diff] [blame] | 919 | netif_rx_ni(skb); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 920 | } |
| 921 | |
Johannes Berg | d582cff | 2012-10-26 17:53:44 +0200 | [diff] [blame] | 922 | static int sta_apply_auth_flags(struct ieee80211_local *local, |
| 923 | struct sta_info *sta, |
| 924 | u32 mask, u32 set) |
| 925 | { |
| 926 | int ret; |
| 927 | |
| 928 | if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) && |
| 929 | set & BIT(NL80211_STA_FLAG_AUTHENTICATED) && |
| 930 | !test_sta_flag(sta, WLAN_STA_AUTH)) { |
| 931 | ret = sta_info_move_state(sta, IEEE80211_STA_AUTH); |
| 932 | if (ret) |
| 933 | return ret; |
| 934 | } |
| 935 | |
| 936 | if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) && |
| 937 | set & BIT(NL80211_STA_FLAG_ASSOCIATED) && |
| 938 | !test_sta_flag(sta, WLAN_STA_ASSOC)) { |
Marek Puzyniak | c23e31c | 2015-03-08 18:04:22 +0200 | [diff] [blame] | 939 | /* |
| 940 | * When peer becomes associated, init rate control as |
| 941 | * well. Some drivers require rate control initialized |
| 942 | * before drv_sta_state() is called. |
| 943 | */ |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 944 | if (!test_sta_flag(sta, WLAN_STA_RATE_CONTROL)) |
Marek Puzyniak | c23e31c | 2015-03-08 18:04:22 +0200 | [diff] [blame] | 945 | rate_control_rate_init(sta); |
| 946 | |
Johannes Berg | d582cff | 2012-10-26 17:53:44 +0200 | [diff] [blame] | 947 | ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC); |
| 948 | if (ret) |
| 949 | return ret; |
| 950 | } |
| 951 | |
| 952 | if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) { |
| 953 | if (set & BIT(NL80211_STA_FLAG_AUTHORIZED)) |
| 954 | ret = sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED); |
| 955 | else if (test_sta_flag(sta, WLAN_STA_AUTHORIZED)) |
| 956 | ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC); |
| 957 | else |
| 958 | ret = 0; |
| 959 | if (ret) |
| 960 | return ret; |
| 961 | } |
| 962 | |
| 963 | if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) && |
| 964 | !(set & BIT(NL80211_STA_FLAG_ASSOCIATED)) && |
| 965 | test_sta_flag(sta, WLAN_STA_ASSOC)) { |
| 966 | ret = sta_info_move_state(sta, IEEE80211_STA_AUTH); |
| 967 | if (ret) |
| 968 | return ret; |
| 969 | } |
| 970 | |
| 971 | if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) && |
| 972 | !(set & BIT(NL80211_STA_FLAG_AUTHENTICATED)) && |
| 973 | test_sta_flag(sta, WLAN_STA_AUTH)) { |
| 974 | ret = sta_info_move_state(sta, IEEE80211_STA_NONE); |
| 975 | if (ret) |
| 976 | return ret; |
| 977 | } |
| 978 | |
| 979 | return 0; |
| 980 | } |
| 981 | |
Johannes Berg | 1365770 | 2015-06-17 10:34:54 +0200 | [diff] [blame] | 982 | static void sta_apply_mesh_params(struct ieee80211_local *local, |
| 983 | struct sta_info *sta, |
| 984 | struct station_parameters *params) |
| 985 | { |
| 986 | #ifdef CONFIG_MAC80211_MESH |
| 987 | struct ieee80211_sub_if_data *sdata = sta->sdata; |
| 988 | u32 changed = 0; |
| 989 | |
| 990 | if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) { |
| 991 | switch (params->plink_state) { |
| 992 | case NL80211_PLINK_ESTAB: |
| 993 | if (sta->mesh->plink_state != NL80211_PLINK_ESTAB) |
| 994 | changed = mesh_plink_inc_estab_count(sdata); |
| 995 | sta->mesh->plink_state = params->plink_state; |
| 996 | |
| 997 | ieee80211_mps_sta_status_update(sta); |
| 998 | changed |= ieee80211_mps_set_sta_local_pm(sta, |
| 999 | sdata->u.mesh.mshcfg.power_mode); |
| 1000 | break; |
| 1001 | case NL80211_PLINK_LISTEN: |
| 1002 | case NL80211_PLINK_BLOCKED: |
| 1003 | case NL80211_PLINK_OPN_SNT: |
| 1004 | case NL80211_PLINK_OPN_RCVD: |
| 1005 | case NL80211_PLINK_CNF_RCVD: |
| 1006 | case NL80211_PLINK_HOLDING: |
| 1007 | if (sta->mesh->plink_state == NL80211_PLINK_ESTAB) |
| 1008 | changed = mesh_plink_dec_estab_count(sdata); |
| 1009 | sta->mesh->plink_state = params->plink_state; |
| 1010 | |
| 1011 | ieee80211_mps_sta_status_update(sta); |
| 1012 | changed |= ieee80211_mps_set_sta_local_pm(sta, |
| 1013 | NL80211_MESH_POWER_UNKNOWN); |
| 1014 | break; |
| 1015 | default: |
| 1016 | /* nothing */ |
| 1017 | break; |
| 1018 | } |
| 1019 | } |
| 1020 | |
| 1021 | switch (params->plink_action) { |
| 1022 | case NL80211_PLINK_ACTION_NO_ACTION: |
| 1023 | /* nothing */ |
| 1024 | break; |
| 1025 | case NL80211_PLINK_ACTION_OPEN: |
| 1026 | changed |= mesh_plink_open(sta); |
| 1027 | break; |
| 1028 | case NL80211_PLINK_ACTION_BLOCK: |
| 1029 | changed |= mesh_plink_block(sta); |
| 1030 | break; |
| 1031 | } |
| 1032 | |
| 1033 | if (params->local_pm) |
| 1034 | changed |= ieee80211_mps_set_sta_local_pm(sta, |
| 1035 | params->local_pm); |
| 1036 | |
| 1037 | ieee80211_mbss_info_change_notify(sdata, changed); |
| 1038 | #endif |
| 1039 | } |
| 1040 | |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1041 | static int sta_apply_parameters(struct ieee80211_local *local, |
| 1042 | struct sta_info *sta, |
| 1043 | struct station_parameters *params) |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1044 | { |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1045 | int ret = 0; |
Johannes Berg | 8318d78 | 2008-01-24 19:38:38 +0100 | [diff] [blame] | 1046 | struct ieee80211_supported_band *sband; |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1047 | struct ieee80211_sub_if_data *sdata = sta->sdata; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1048 | enum ieee80211_band band = ieee80211_get_sdata_band(sdata); |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1049 | u32 mask, set; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1050 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1051 | sband = local->hw.wiphy->bands[band]; |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 1052 | |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1053 | mask = params->sta_flags_mask; |
| 1054 | set = params->sta_flags_set; |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1055 | |
Johannes Berg | d582cff | 2012-10-26 17:53:44 +0200 | [diff] [blame] | 1056 | if (ieee80211_vif_is_mesh(&sdata->vif)) { |
| 1057 | /* |
| 1058 | * In mesh mode, ASSOCIATED isn't part of the nl80211 |
| 1059 | * API but must follow AUTHENTICATED for driver state. |
| 1060 | */ |
| 1061 | if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED)) |
| 1062 | mask |= BIT(NL80211_STA_FLAG_ASSOCIATED); |
| 1063 | if (set & BIT(NL80211_STA_FLAG_AUTHENTICATED)) |
| 1064 | set |= BIT(NL80211_STA_FLAG_ASSOCIATED); |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1065 | } else if (test_sta_flag(sta, WLAN_STA_TDLS_PEER)) { |
| 1066 | /* |
| 1067 | * TDLS -- everything follows authorized, but |
| 1068 | * only becoming authorized is possible, not |
| 1069 | * going back |
| 1070 | */ |
| 1071 | if (set & BIT(NL80211_STA_FLAG_AUTHORIZED)) { |
| 1072 | set |= BIT(NL80211_STA_FLAG_AUTHENTICATED) | |
| 1073 | BIT(NL80211_STA_FLAG_ASSOCIATED); |
| 1074 | mask |= BIT(NL80211_STA_FLAG_AUTHENTICATED) | |
| 1075 | BIT(NL80211_STA_FLAG_ASSOCIATED); |
| 1076 | } |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1077 | } |
| 1078 | |
Johannes Berg | 2c44be8 | 2015-03-30 15:09:20 +0200 | [diff] [blame] | 1079 | if (mask & BIT(NL80211_STA_FLAG_WME) && |
| 1080 | local->hw.queues >= IEEE80211_NUM_ACS) |
| 1081 | sta->sta.wme = set & BIT(NL80211_STA_FLAG_WME); |
| 1082 | |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1083 | /* auth flags will be set later for TDLS, |
| 1084 | * and for unassociated stations that move to assocaited */ |
| 1085 | if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) && |
| 1086 | !((mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) && |
| 1087 | (set & BIT(NL80211_STA_FLAG_ASSOCIATED)))) { |
Arik Nemtsov | 68885a5 | 2014-06-11 17:18:19 +0300 | [diff] [blame] | 1088 | ret = sta_apply_auth_flags(local, sta, mask, set); |
| 1089 | if (ret) |
| 1090 | return ret; |
| 1091 | } |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1092 | |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1093 | if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) { |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1094 | if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 1095 | set_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE); |
| 1096 | else |
| 1097 | clear_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE); |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1098 | } |
| 1099 | |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1100 | if (mask & BIT(NL80211_STA_FLAG_MFP)) { |
Tamizh chelvam | 93f0490 | 2015-10-07 10:40:04 +0530 | [diff] [blame] | 1101 | sta->sta.mfp = !!(set & BIT(NL80211_STA_FLAG_MFP)); |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1102 | if (set & BIT(NL80211_STA_FLAG_MFP)) |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 1103 | set_sta_flag(sta, WLAN_STA_MFP); |
| 1104 | else |
| 1105 | clear_sta_flag(sta, WLAN_STA_MFP); |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1106 | } |
Javier Cardona | b39c48f | 2011-04-07 15:08:30 -0700 | [diff] [blame] | 1107 | |
Arik Nemtsov | 07ba55d | 2011-09-28 14:12:53 +0300 | [diff] [blame] | 1108 | if (mask & BIT(NL80211_STA_FLAG_TDLS_PEER)) { |
Arik Nemtsov | 07ba55d | 2011-09-28 14:12:53 +0300 | [diff] [blame] | 1109 | if (set & BIT(NL80211_STA_FLAG_TDLS_PEER)) |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 1110 | set_sta_flag(sta, WLAN_STA_TDLS_PEER); |
| 1111 | else |
| 1112 | clear_sta_flag(sta, WLAN_STA_TDLS_PEER); |
Arik Nemtsov | 07ba55d | 2011-09-28 14:12:53 +0300 | [diff] [blame] | 1113 | } |
Johannes Berg | eccb8e8 | 2009-05-11 21:57:56 +0300 | [diff] [blame] | 1114 | |
Arik Nemtsov | 9041c1f | 2014-11-09 18:50:15 +0200 | [diff] [blame] | 1115 | /* mark TDLS channel switch support, if the AP allows it */ |
| 1116 | if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) && |
| 1117 | !sdata->u.mgd.tdls_chan_switch_prohibited && |
| 1118 | params->ext_capab_len >= 4 && |
| 1119 | params->ext_capab[3] & WLAN_EXT_CAPA4_TDLS_CHAN_SWITCH) |
| 1120 | set_sta_flag(sta, WLAN_STA_TDLS_CHAN_SWITCH); |
| 1121 | |
Arik Nemtsov | b98fb44 | 2015-06-10 20:42:59 +0300 | [diff] [blame] | 1122 | if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) && |
Arik Nemtsov | 82c0cc9 | 2015-08-15 22:39:46 +0300 | [diff] [blame] | 1123 | !sdata->u.mgd.tdls_wider_bw_prohibited && |
Arik Nemtsov | b98fb44 | 2015-06-10 20:42:59 +0300 | [diff] [blame] | 1124 | ieee80211_hw_check(&local->hw, TDLS_WIDER_BW) && |
| 1125 | params->ext_capab_len >= 8 && |
| 1126 | params->ext_capab[7] & WLAN_EXT_CAPA8_TDLS_WIDE_BW_ENABLED) |
| 1127 | set_sta_flag(sta, WLAN_STA_TDLS_WIDER_BW); |
| 1128 | |
Johannes Berg | 3b9ce80 | 2011-09-27 20:56:12 +0200 | [diff] [blame] | 1129 | if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) { |
| 1130 | sta->sta.uapsd_queues = params->uapsd_queues; |
| 1131 | sta->sta.max_sp = params->max_sp; |
| 1132 | } |
Eliad Peller | 9533b4a | 2011-08-23 14:37:47 +0300 | [diff] [blame] | 1133 | |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1134 | /* |
Johannes Berg | 51b50fb | 2009-05-24 16:42:30 +0200 | [diff] [blame] | 1135 | * cfg80211 validates this (1-2007) and allows setting the AID |
| 1136 | * only when creating a new station entry |
| 1137 | */ |
| 1138 | if (params->aid) |
| 1139 | sta->sta.aid = params->aid; |
| 1140 | |
| 1141 | /* |
Johannes Berg | ba23d20 | 2012-12-27 17:32:09 +0100 | [diff] [blame] | 1142 | * Some of the following updates would be racy if called on an |
| 1143 | * existing station, via ieee80211_change_station(). However, |
| 1144 | * all such changes are rejected by cfg80211 except for updates |
| 1145 | * changing the supported rates on an existing but not yet used |
| 1146 | * TDLS peer. |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1147 | */ |
| 1148 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1149 | if (params->listen_interval >= 0) |
| 1150 | sta->listen_interval = params->listen_interval; |
| 1151 | |
| 1152 | if (params->supported_rates) { |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 1153 | ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef, |
| 1154 | sband, params->supported_rates, |
| 1155 | params->supported_rates_len, |
| 1156 | &sta->sta.supp_rates[band]); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1157 | } |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1158 | |
Johannes Berg | d9fe60d | 2008-10-09 12:13:49 +0200 | [diff] [blame] | 1159 | if (params->ht_capa) |
Ben Greear | ef96a842 | 2011-11-18 11:32:00 -0800 | [diff] [blame] | 1160 | ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband, |
Johannes Berg | e1a0c6b | 2013-02-07 11:47:44 +0100 | [diff] [blame] | 1161 | params->ht_capa, sta); |
Jouni Malinen | 36aedc90 | 2008-08-25 11:58:58 +0300 | [diff] [blame] | 1162 | |
Mahesh Palivela | f461be3e | 2012-10-11 08:04:52 +0000 | [diff] [blame] | 1163 | if (params->vht_capa) |
| 1164 | ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband, |
Johannes Berg | 4a34215 | 2013-02-07 11:58:58 +0100 | [diff] [blame] | 1165 | params->vht_capa, sta); |
Mahesh Palivela | f461be3e | 2012-10-11 08:04:52 +0000 | [diff] [blame] | 1166 | |
Marek Kwaczynski | b1bce14 | 2014-02-03 14:44:44 +0100 | [diff] [blame] | 1167 | if (params->opmode_notif_used) { |
Marek Kwaczynski | b1bce14 | 2014-02-03 14:44:44 +0100 | [diff] [blame] | 1168 | /* returned value is only needed for rc update, but the |
| 1169 | * rc isn't initialized here yet, so ignore it |
| 1170 | */ |
| 1171 | __ieee80211_vht_handle_opmode(sdata, sta, |
| 1172 | params->opmode_notif, |
| 1173 | band, false); |
| 1174 | } |
| 1175 | |
Johannes Berg | 1365770 | 2015-06-17 10:34:54 +0200 | [diff] [blame] | 1176 | if (ieee80211_vif_is_mesh(&sdata->vif)) |
| 1177 | sta_apply_mesh_params(local, sta, params); |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1178 | |
Arik Nemtsov | 68885a5 | 2014-06-11 17:18:19 +0300 | [diff] [blame] | 1179 | /* set the STA state after all sta info from usermode has been set */ |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1180 | if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) || |
| 1181 | set & BIT(NL80211_STA_FLAG_ASSOCIATED)) { |
Arik Nemtsov | 68885a5 | 2014-06-11 17:18:19 +0300 | [diff] [blame] | 1182 | ret = sta_apply_auth_flags(local, sta, mask, set); |
| 1183 | if (ret) |
| 1184 | return ret; |
| 1185 | } |
| 1186 | |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1187 | return 0; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1188 | } |
| 1189 | |
| 1190 | static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 1191 | const u8 *mac, |
| 1192 | struct station_parameters *params) |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1193 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1194 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1195 | struct sta_info *sta; |
| 1196 | struct ieee80211_sub_if_data *sdata; |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1197 | int err; |
Jouni Malinen | b8d476c | 2008-12-12 17:08:31 +0200 | [diff] [blame] | 1198 | int layer2_update; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1199 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1200 | if (params->vlan) { |
| 1201 | sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan); |
| 1202 | |
Johannes Berg | 05c914f | 2008-09-11 00:01:58 +0200 | [diff] [blame] | 1203 | if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN && |
| 1204 | sdata->vif.type != NL80211_IFTYPE_AP) |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1205 | return -EINVAL; |
| 1206 | } else |
| 1207 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1208 | |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 1209 | if (ether_addr_equal(mac, sdata->vif.addr)) |
Johannes Berg | 03e4497 | 2008-02-27 09:56:40 +0100 | [diff] [blame] | 1210 | return -EINVAL; |
| 1211 | |
| 1212 | if (is_multicast_ether_addr(mac)) |
| 1213 | return -EINVAL; |
| 1214 | |
| 1215 | sta = sta_info_alloc(sdata, mac, GFP_KERNEL); |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1216 | if (!sta) |
| 1217 | return -ENOMEM; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1218 | |
Johannes Berg | d582cff | 2012-10-26 17:53:44 +0200 | [diff] [blame] | 1219 | /* |
| 1220 | * defaults -- if userspace wants something else we'll |
| 1221 | * change it accordingly in sta_apply_parameters() |
| 1222 | */ |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1223 | if (!(params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) && |
| 1224 | !(params->sta_flags_set & (BIT(NL80211_STA_FLAG_AUTHENTICATED) | |
| 1225 | BIT(NL80211_STA_FLAG_ASSOCIATED)))) { |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1226 | sta_info_pre_move_state(sta, IEEE80211_STA_AUTH); |
| 1227 | sta_info_pre_move_state(sta, IEEE80211_STA_ASSOC); |
| 1228 | } |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1229 | if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER)) |
| 1230 | sta->sta.tdls = true; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1231 | |
Johannes Berg | d9a7ddb | 2011-12-14 12:35:30 +0100 | [diff] [blame] | 1232 | err = sta_apply_parameters(local, sta, params); |
| 1233 | if (err) { |
| 1234 | sta_info_free(local, sta); |
| 1235 | return err; |
| 1236 | } |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1237 | |
Arik Nemtsov | d64cf63 | 2011-11-07 23:24:39 +0200 | [diff] [blame] | 1238 | /* |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1239 | * for TDLS and for unassociated station, rate control should be |
| 1240 | * initialized only when rates are known and station is marked |
| 1241 | * authorized/associated |
Arik Nemtsov | d64cf63 | 2011-11-07 23:24:39 +0200 | [diff] [blame] | 1242 | */ |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1243 | if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) && |
| 1244 | test_sta_flag(sta, WLAN_STA_ASSOC)) |
Arik Nemtsov | d64cf63 | 2011-11-07 23:24:39 +0200 | [diff] [blame] | 1245 | rate_control_rate_init(sta); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1246 | |
Jouni Malinen | b8d476c | 2008-12-12 17:08:31 +0200 | [diff] [blame] | 1247 | layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN || |
| 1248 | sdata->vif.type == NL80211_IFTYPE_AP; |
| 1249 | |
Johannes Berg | 34e8950 | 2010-02-03 13:59:58 +0100 | [diff] [blame] | 1250 | err = sta_info_insert_rcu(sta); |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1251 | if (err) { |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1252 | rcu_read_unlock(); |
| 1253 | return err; |
| 1254 | } |
| 1255 | |
Jouni Malinen | b8d476c | 2008-12-12 17:08:31 +0200 | [diff] [blame] | 1256 | if (layer2_update) |
Johannes Berg | 73651ee | 2008-02-25 16:27:47 +0100 | [diff] [blame] | 1257 | ieee80211_send_layer2_update(sta); |
| 1258 | |
| 1259 | rcu_read_unlock(); |
| 1260 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1261 | return 0; |
| 1262 | } |
| 1263 | |
| 1264 | static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev, |
Jouni Malinen | 89c771e | 2014-10-10 20:52:40 +0300 | [diff] [blame] | 1265 | struct station_del_parameters *params) |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1266 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1267 | struct ieee80211_sub_if_data *sdata; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1268 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1269 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1270 | |
Jouni Malinen | 89c771e | 2014-10-10 20:52:40 +0300 | [diff] [blame] | 1271 | if (params->mac) |
| 1272 | return sta_info_destroy_addr_bss(sdata, params->mac); |
Johannes Berg | 98dd6a5 | 2008-04-10 15:36:09 +0200 | [diff] [blame] | 1273 | |
Johannes Berg | b998e8b | 2012-12-13 23:07:46 +0100 | [diff] [blame] | 1274 | sta_info_flush(sdata); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1275 | return 0; |
| 1276 | } |
| 1277 | |
| 1278 | static int ieee80211_change_station(struct wiphy *wiphy, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 1279 | struct net_device *dev, const u8 *mac, |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1280 | struct station_parameters *params) |
| 1281 | { |
Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 1282 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1283 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1284 | struct sta_info *sta; |
| 1285 | struct ieee80211_sub_if_data *vlansdata; |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1286 | enum cfg80211_station_type statype; |
Eliad Peller | 35b8862 | 2011-12-29 14:41:39 +0200 | [diff] [blame] | 1287 | int err; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1288 | |
Johannes Berg | 87be1e1 | 2011-12-14 12:20:29 +0100 | [diff] [blame] | 1289 | mutex_lock(&local->sta_mtx); |
Johannes Berg | 98dd6a5 | 2008-04-10 15:36:09 +0200 | [diff] [blame] | 1290 | |
Felix Fietkau | 0e5ded5 | 2010-01-08 18:10:58 +0100 | [diff] [blame] | 1291 | sta = sta_info_get_bss(sdata, mac); |
Johannes Berg | 98dd6a5 | 2008-04-10 15:36:09 +0200 | [diff] [blame] | 1292 | if (!sta) { |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1293 | err = -ENOENT; |
| 1294 | goto out_err; |
Johannes Berg | 98dd6a5 | 2008-04-10 15:36:09 +0200 | [diff] [blame] | 1295 | } |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1296 | |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1297 | switch (sdata->vif.type) { |
| 1298 | case NL80211_IFTYPE_MESH_POINT: |
Thomas Pedersen | a6dad6a | 2013-03-04 13:06:12 -0800 | [diff] [blame] | 1299 | if (sdata->u.mesh.user_mpm) |
Thomas Pedersen | eef941e | 2013-03-04 13:06:11 -0800 | [diff] [blame] | 1300 | statype = CFG80211_STA_MESH_PEER_USER; |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1301 | else |
Thomas Pedersen | eef941e | 2013-03-04 13:06:11 -0800 | [diff] [blame] | 1302 | statype = CFG80211_STA_MESH_PEER_KERNEL; |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1303 | break; |
| 1304 | case NL80211_IFTYPE_ADHOC: |
| 1305 | statype = CFG80211_STA_IBSS; |
| 1306 | break; |
| 1307 | case NL80211_IFTYPE_STATION: |
| 1308 | if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER)) { |
| 1309 | statype = CFG80211_STA_AP_STA; |
| 1310 | break; |
| 1311 | } |
| 1312 | if (test_sta_flag(sta, WLAN_STA_AUTHORIZED)) |
| 1313 | statype = CFG80211_STA_TDLS_PEER_ACTIVE; |
| 1314 | else |
| 1315 | statype = CFG80211_STA_TDLS_PEER_SETUP; |
| 1316 | break; |
| 1317 | case NL80211_IFTYPE_AP: |
| 1318 | case NL80211_IFTYPE_AP_VLAN: |
Ayala Beker | 44674d9 | 2015-09-23 10:41:27 +0200 | [diff] [blame] | 1319 | if (test_sta_flag(sta, WLAN_STA_ASSOC)) |
| 1320 | statype = CFG80211_STA_AP_CLIENT; |
| 1321 | else |
| 1322 | statype = CFG80211_STA_AP_CLIENT_UNASSOC; |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1323 | break; |
| 1324 | default: |
| 1325 | err = -EOPNOTSUPP; |
| 1326 | goto out_err; |
Johannes Berg | bdd90d5 | 2011-12-14 12:20:27 +0100 | [diff] [blame] | 1327 | } |
| 1328 | |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1329 | err = cfg80211_check_station_change(wiphy, params, statype); |
| 1330 | if (err) |
| 1331 | goto out_err; |
| 1332 | |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1333 | if (params->vlan && params->vlan != sta->sdata->dev) { |
Felix Fietkau | 7e3ed02 | 2012-04-23 19:49:03 +0200 | [diff] [blame] | 1334 | bool prev_4addr = false; |
| 1335 | bool new_4addr = false; |
| 1336 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1337 | vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan); |
| 1338 | |
Johannes Berg | 9bc383d | 2009-11-19 11:55:19 +0100 | [diff] [blame] | 1339 | if (params->vlan->ieee80211_ptr->use_4addr) { |
Johannes Berg | 3305443 | 2009-11-20 10:09:14 +0100 | [diff] [blame] | 1340 | if (vlansdata->u.vlan.sta) { |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1341 | err = -EBUSY; |
| 1342 | goto out_err; |
Johannes Berg | 3305443 | 2009-11-20 10:09:14 +0100 | [diff] [blame] | 1343 | } |
Felix Fietkau | f14543ee | 2009-11-10 20:10:05 +0100 | [diff] [blame] | 1344 | |
Eric Dumazet | cf778b0 | 2012-01-12 04:41:32 +0000 | [diff] [blame] | 1345 | rcu_assign_pointer(vlansdata->u.vlan.sta, sta); |
Felix Fietkau | 7e3ed02 | 2012-04-23 19:49:03 +0200 | [diff] [blame] | 1346 | new_4addr = true; |
| 1347 | } |
| 1348 | |
| 1349 | if (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN && |
| 1350 | sta->sdata->u.vlan.sta) { |
Monam Agarwal | 0c2bef46 | 2014-03-24 00:51:43 +0530 | [diff] [blame] | 1351 | RCU_INIT_POINTER(sta->sdata->u.vlan.sta, NULL); |
Felix Fietkau | 7e3ed02 | 2012-04-23 19:49:03 +0200 | [diff] [blame] | 1352 | prev_4addr = true; |
Felix Fietkau | f14543ee | 2009-11-10 20:10:05 +0100 | [diff] [blame] | 1353 | } |
| 1354 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1355 | sta->sdata = vlansdata; |
Michal Kazior | 464daaf | 2015-05-19 14:13:36 +0200 | [diff] [blame] | 1356 | ieee80211_check_fast_xmit(sta); |
Felix Fietkau | 7e3ed02 | 2012-04-23 19:49:03 +0200 | [diff] [blame] | 1357 | |
| 1358 | if (sta->sta_state == IEEE80211_STA_AUTHORIZED && |
| 1359 | prev_4addr != new_4addr) { |
| 1360 | if (new_4addr) |
| 1361 | atomic_dec(&sta->sdata->bss->num_mcast_sta); |
| 1362 | else |
| 1363 | atomic_inc(&sta->sdata->bss->num_mcast_sta); |
| 1364 | } |
| 1365 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1366 | ieee80211_send_layer2_update(sta); |
| 1367 | } |
| 1368 | |
Eliad Peller | 35b8862 | 2011-12-29 14:41:39 +0200 | [diff] [blame] | 1369 | err = sta_apply_parameters(local, sta, params); |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1370 | if (err) |
| 1371 | goto out_err; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1372 | |
Johannes Berg | 87be1e1 | 2011-12-14 12:20:29 +0100 | [diff] [blame] | 1373 | mutex_unlock(&local->sta_mtx); |
Johannes Berg | 98dd6a5 | 2008-04-10 15:36:09 +0200 | [diff] [blame] | 1374 | |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 1375 | if ((sdata->vif.type == NL80211_IFTYPE_AP || |
| 1376 | sdata->vif.type == NL80211_IFTYPE_AP_VLAN) && |
| 1377 | sta->known_smps_mode != sta->sdata->bss->req_smps && |
| 1378 | test_sta_flag(sta, WLAN_STA_AUTHORIZED) && |
| 1379 | sta_info_tx_streams(sta) != 1) { |
| 1380 | ht_dbg(sta->sdata, |
| 1381 | "%pM just authorized and MIMO capable - update SMPS\n", |
| 1382 | sta->sta.addr); |
| 1383 | ieee80211_send_smps_action(sta->sdata, |
| 1384 | sta->sdata->bss->req_smps, |
| 1385 | sta->sta.addr, |
| 1386 | sta->sdata->vif.bss_conf.bssid); |
| 1387 | } |
| 1388 | |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1389 | if (sdata->vif.type == NL80211_IFTYPE_STATION && |
Eliad Peller | ab09587 | 2012-07-27 12:33:22 +0300 | [diff] [blame] | 1390 | params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) { |
Johannes Berg | 4a733ef | 2015-10-14 18:02:43 +0200 | [diff] [blame] | 1391 | ieee80211_recalc_ps(local); |
Eliad Peller | ab09587 | 2012-07-27 12:33:22 +0300 | [diff] [blame] | 1392 | ieee80211_recalc_ps_vif(sdata); |
| 1393 | } |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1394 | |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1395 | return 0; |
Johannes Berg | 77ee7c8 | 2013-02-15 00:48:33 +0100 | [diff] [blame] | 1396 | out_err: |
| 1397 | mutex_unlock(&local->sta_mtx); |
| 1398 | return err; |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 1399 | } |
| 1400 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1401 | #ifdef CONFIG_MAC80211_MESH |
| 1402 | static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 1403 | const u8 *dst, const u8 *next_hop) |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1404 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1405 | struct ieee80211_sub_if_data *sdata; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1406 | struct mesh_path *mpath; |
| 1407 | struct sta_info *sta; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1408 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1409 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1410 | |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1411 | rcu_read_lock(); |
Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 1412 | sta = sta_info_get(sdata, next_hop); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1413 | if (!sta) { |
| 1414 | rcu_read_unlock(); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1415 | return -ENOENT; |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1416 | } |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1417 | |
Bob Copeland | ae76eef | 2013-03-29 09:38:39 -0400 | [diff] [blame] | 1418 | mpath = mesh_path_add(sdata, dst); |
| 1419 | if (IS_ERR(mpath)) { |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1420 | rcu_read_unlock(); |
Bob Copeland | ae76eef | 2013-03-29 09:38:39 -0400 | [diff] [blame] | 1421 | return PTR_ERR(mpath); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1422 | } |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1423 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1424 | mesh_path_fix_nexthop(mpath, sta); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1425 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1426 | rcu_read_unlock(); |
| 1427 | return 0; |
| 1428 | } |
| 1429 | |
| 1430 | static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 1431 | const u8 *dst) |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1432 | { |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 1433 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1434 | |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 1435 | if (dst) |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 1436 | return mesh_path_del(sdata, dst); |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 1437 | |
Javier Cardona | ece1a2e | 2011-08-29 13:23:04 -0700 | [diff] [blame] | 1438 | mesh_path_flush_by_iface(sdata); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1439 | return 0; |
| 1440 | } |
| 1441 | |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 1442 | static int ieee80211_change_mpath(struct wiphy *wiphy, struct net_device *dev, |
| 1443 | const u8 *dst, const u8 *next_hop) |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1444 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1445 | struct ieee80211_sub_if_data *sdata; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1446 | struct mesh_path *mpath; |
| 1447 | struct sta_info *sta; |
| 1448 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1449 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1450 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1451 | rcu_read_lock(); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1452 | |
Johannes Berg | abe6063 | 2009-11-25 17:46:18 +0100 | [diff] [blame] | 1453 | sta = sta_info_get(sdata, next_hop); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1454 | if (!sta) { |
| 1455 | rcu_read_unlock(); |
| 1456 | return -ENOENT; |
| 1457 | } |
| 1458 | |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 1459 | mpath = mesh_path_lookup(sdata, dst); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1460 | if (!mpath) { |
| 1461 | rcu_read_unlock(); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1462 | return -ENOENT; |
| 1463 | } |
| 1464 | |
| 1465 | mesh_path_fix_nexthop(mpath, sta); |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 1466 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1467 | rcu_read_unlock(); |
| 1468 | return 0; |
| 1469 | } |
| 1470 | |
| 1471 | static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop, |
| 1472 | struct mpath_info *pinfo) |
| 1473 | { |
Johannes Berg | a3836e0 | 2011-05-12 15:11:37 +0200 | [diff] [blame] | 1474 | struct sta_info *next_hop_sta = rcu_dereference(mpath->next_hop); |
| 1475 | |
| 1476 | if (next_hop_sta) |
| 1477 | memcpy(next_hop, next_hop_sta->sta.addr, ETH_ALEN); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1478 | else |
Joe Perches | c84a67a | 2015-03-02 19:54:57 -0800 | [diff] [blame] | 1479 | eth_zero_addr(next_hop); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1480 | |
LEO Airwarosu Yoichi Shinoda | 7ce8c7a | 2012-08-27 22:28:16 +0900 | [diff] [blame] | 1481 | memset(pinfo, 0, sizeof(*pinfo)); |
| 1482 | |
Johannes Berg | f5ea912 | 2009-08-07 16:17:38 +0200 | [diff] [blame] | 1483 | pinfo->generation = mesh_paths_generation; |
| 1484 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1485 | pinfo->filled = MPATH_INFO_FRAME_QLEN | |
Rui Paulo | d19b3bf | 2009-11-09 23:46:55 +0000 | [diff] [blame] | 1486 | MPATH_INFO_SN | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1487 | MPATH_INFO_METRIC | |
| 1488 | MPATH_INFO_EXPTIME | |
| 1489 | MPATH_INFO_DISCOVERY_TIMEOUT | |
| 1490 | MPATH_INFO_DISCOVERY_RETRIES | |
| 1491 | MPATH_INFO_FLAGS; |
| 1492 | |
| 1493 | pinfo->frame_qlen = mpath->frame_queue.qlen; |
Rui Paulo | d19b3bf | 2009-11-09 23:46:55 +0000 | [diff] [blame] | 1494 | pinfo->sn = mpath->sn; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1495 | pinfo->metric = mpath->metric; |
| 1496 | if (time_before(jiffies, mpath->exp_time)) |
| 1497 | pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies); |
| 1498 | pinfo->discovery_timeout = |
| 1499 | jiffies_to_msecs(mpath->discovery_timeout); |
| 1500 | pinfo->discovery_retries = mpath->discovery_retries; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1501 | if (mpath->flags & MESH_PATH_ACTIVE) |
| 1502 | pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE; |
| 1503 | if (mpath->flags & MESH_PATH_RESOLVING) |
| 1504 | pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING; |
Rui Paulo | d19b3bf | 2009-11-09 23:46:55 +0000 | [diff] [blame] | 1505 | if (mpath->flags & MESH_PATH_SN_VALID) |
| 1506 | pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1507 | if (mpath->flags & MESH_PATH_FIXED) |
| 1508 | pinfo->flags |= NL80211_MPATH_FLAG_FIXED; |
LEO Airwarosu Yoichi Shinoda | 7ce8c7a | 2012-08-27 22:28:16 +0900 | [diff] [blame] | 1509 | if (mpath->flags & MESH_PATH_RESOLVED) |
| 1510 | pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1511 | } |
| 1512 | |
| 1513 | static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev, |
| 1514 | u8 *dst, u8 *next_hop, struct mpath_info *pinfo) |
| 1515 | |
| 1516 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1517 | struct ieee80211_sub_if_data *sdata; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1518 | struct mesh_path *mpath; |
| 1519 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1520 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1521 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1522 | rcu_read_lock(); |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 1523 | mpath = mesh_path_lookup(sdata, dst); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1524 | if (!mpath) { |
| 1525 | rcu_read_unlock(); |
| 1526 | return -ENOENT; |
| 1527 | } |
| 1528 | memcpy(dst, mpath->dst, ETH_ALEN); |
| 1529 | mpath_set_pinfo(mpath, next_hop, pinfo); |
| 1530 | rcu_read_unlock(); |
| 1531 | return 0; |
| 1532 | } |
| 1533 | |
| 1534 | static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 3b3a016 | 2014-05-19 17:19:31 +0200 | [diff] [blame] | 1535 | int idx, u8 *dst, u8 *next_hop, |
| 1536 | struct mpath_info *pinfo) |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1537 | { |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1538 | struct ieee80211_sub_if_data *sdata; |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1539 | struct mesh_path *mpath; |
| 1540 | |
Johannes Berg | 14db74b | 2008-07-29 13:22:52 +0200 | [diff] [blame] | 1541 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1542 | |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1543 | rcu_read_lock(); |
Johannes Berg | bf7cd94 | 2013-02-15 14:40:31 +0100 | [diff] [blame] | 1544 | mpath = mesh_path_lookup_by_idx(sdata, idx); |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1545 | if (!mpath) { |
| 1546 | rcu_read_unlock(); |
| 1547 | return -ENOENT; |
| 1548 | } |
| 1549 | memcpy(dst, mpath->dst, ETH_ALEN); |
| 1550 | mpath_set_pinfo(mpath, next_hop, pinfo); |
| 1551 | rcu_read_unlock(); |
| 1552 | return 0; |
| 1553 | } |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1554 | |
Henning Rogge | a2db2ed | 2014-09-12 08:58:50 +0200 | [diff] [blame] | 1555 | static void mpp_set_pinfo(struct mesh_path *mpath, u8 *mpp, |
| 1556 | struct mpath_info *pinfo) |
| 1557 | { |
| 1558 | memset(pinfo, 0, sizeof(*pinfo)); |
| 1559 | memcpy(mpp, mpath->mpp, ETH_ALEN); |
| 1560 | |
| 1561 | pinfo->generation = mpp_paths_generation; |
| 1562 | } |
| 1563 | |
| 1564 | static int ieee80211_get_mpp(struct wiphy *wiphy, struct net_device *dev, |
| 1565 | u8 *dst, u8 *mpp, struct mpath_info *pinfo) |
| 1566 | |
| 1567 | { |
| 1568 | struct ieee80211_sub_if_data *sdata; |
| 1569 | struct mesh_path *mpath; |
| 1570 | |
| 1571 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1572 | |
| 1573 | rcu_read_lock(); |
| 1574 | mpath = mpp_path_lookup(sdata, dst); |
| 1575 | if (!mpath) { |
| 1576 | rcu_read_unlock(); |
| 1577 | return -ENOENT; |
| 1578 | } |
| 1579 | memcpy(dst, mpath->dst, ETH_ALEN); |
| 1580 | mpp_set_pinfo(mpath, mpp, pinfo); |
| 1581 | rcu_read_unlock(); |
| 1582 | return 0; |
| 1583 | } |
| 1584 | |
| 1585 | static int ieee80211_dump_mpp(struct wiphy *wiphy, struct net_device *dev, |
| 1586 | int idx, u8 *dst, u8 *mpp, |
| 1587 | struct mpath_info *pinfo) |
| 1588 | { |
| 1589 | struct ieee80211_sub_if_data *sdata; |
| 1590 | struct mesh_path *mpath; |
| 1591 | |
| 1592 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1593 | |
| 1594 | rcu_read_lock(); |
| 1595 | mpath = mpp_path_lookup_by_idx(sdata, idx); |
| 1596 | if (!mpath) { |
| 1597 | rcu_read_unlock(); |
| 1598 | return -ENOENT; |
| 1599 | } |
| 1600 | memcpy(dst, mpath->dst, ETH_ALEN); |
| 1601 | mpp_set_pinfo(mpath, mpp, pinfo); |
| 1602 | rcu_read_unlock(); |
| 1603 | return 0; |
| 1604 | } |
| 1605 | |
Javier Cardona | 24bdd9f | 2010-12-16 17:37:48 -0800 | [diff] [blame] | 1606 | static int ieee80211_get_mesh_config(struct wiphy *wiphy, |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1607 | struct net_device *dev, |
| 1608 | struct mesh_config *conf) |
| 1609 | { |
| 1610 | struct ieee80211_sub_if_data *sdata; |
| 1611 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1612 | |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1613 | memcpy(conf, &(sdata->u.mesh.mshcfg), sizeof(struct mesh_config)); |
| 1614 | return 0; |
| 1615 | } |
| 1616 | |
| 1617 | static inline bool _chg_mesh_attr(enum nl80211_meshconf_params parm, u32 mask) |
| 1618 | { |
| 1619 | return (mask >> (parm-1)) & 0x1; |
| 1620 | } |
| 1621 | |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1622 | static int copy_mesh_setup(struct ieee80211_if_mesh *ifmsh, |
| 1623 | const struct mesh_setup *setup) |
| 1624 | { |
| 1625 | u8 *new_ie; |
| 1626 | const u8 *old_ie; |
Chun-Yeow Yeoh | 4bb6234 | 2011-11-24 17:15:20 -0800 | [diff] [blame] | 1627 | struct ieee80211_sub_if_data *sdata = container_of(ifmsh, |
| 1628 | struct ieee80211_sub_if_data, u.mesh); |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1629 | |
Javier Cardona | 581a8b0 | 2011-04-07 15:08:27 -0700 | [diff] [blame] | 1630 | /* allocate information elements */ |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1631 | new_ie = NULL; |
Javier Cardona | 581a8b0 | 2011-04-07 15:08:27 -0700 | [diff] [blame] | 1632 | old_ie = ifmsh->ie; |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1633 | |
Javier Cardona | 581a8b0 | 2011-04-07 15:08:27 -0700 | [diff] [blame] | 1634 | if (setup->ie_len) { |
| 1635 | new_ie = kmemdup(setup->ie, setup->ie_len, |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1636 | GFP_KERNEL); |
| 1637 | if (!new_ie) |
| 1638 | return -ENOMEM; |
| 1639 | } |
Javier Cardona | 581a8b0 | 2011-04-07 15:08:27 -0700 | [diff] [blame] | 1640 | ifmsh->ie_len = setup->ie_len; |
| 1641 | ifmsh->ie = new_ie; |
| 1642 | kfree(old_ie); |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1643 | |
| 1644 | /* now copy the rest of the setup parameters */ |
| 1645 | ifmsh->mesh_id_len = setup->mesh_id_len; |
| 1646 | memcpy(ifmsh->mesh_id, setup->mesh_id, ifmsh->mesh_id_len); |
Javier Cardona | d299a1f | 2012-03-31 11:31:33 -0700 | [diff] [blame] | 1647 | ifmsh->mesh_sp_id = setup->sync_method; |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1648 | ifmsh->mesh_pp_id = setup->path_sel_proto; |
| 1649 | ifmsh->mesh_pm_id = setup->path_metric; |
Thomas Pedersen | a6dad6a | 2013-03-04 13:06:12 -0800 | [diff] [blame] | 1650 | ifmsh->user_mpm = setup->user_mpm; |
Colleen Twitty | 0d4261a | 2013-05-08 11:46:00 -0700 | [diff] [blame] | 1651 | ifmsh->mesh_auth_id = setup->auth_id; |
Javier Cardona | b130e5c | 2011-05-03 16:57:07 -0700 | [diff] [blame] | 1652 | ifmsh->security = IEEE80211_MESH_SEC_NONE; |
| 1653 | if (setup->is_authenticated) |
| 1654 | ifmsh->security |= IEEE80211_MESH_SEC_AUTHED; |
| 1655 | if (setup->is_secure) |
| 1656 | ifmsh->security |= IEEE80211_MESH_SEC_SECURED; |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1657 | |
Chun-Yeow Yeoh | 4bb6234 | 2011-11-24 17:15:20 -0800 | [diff] [blame] | 1658 | /* mcast rate setting in Mesh Node */ |
| 1659 | memcpy(sdata->vif.bss_conf.mcast_rate, setup->mcast_rate, |
| 1660 | sizeof(setup->mcast_rate)); |
Ashok Nagarajan | ffb3cf3 | 2013-06-03 10:33:36 -0700 | [diff] [blame] | 1661 | sdata->vif.bss_conf.basic_rates = setup->basic_rates; |
Chun-Yeow Yeoh | 4bb6234 | 2011-11-24 17:15:20 -0800 | [diff] [blame] | 1662 | |
Marco Porsch | 9bdbf04 | 2013-01-07 16:04:51 +0100 | [diff] [blame] | 1663 | sdata->vif.bss_conf.beacon_int = setup->beacon_interval; |
| 1664 | sdata->vif.bss_conf.dtim_period = setup->dtim_period; |
| 1665 | |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1666 | return 0; |
| 1667 | } |
| 1668 | |
Javier Cardona | 24bdd9f | 2010-12-16 17:37:48 -0800 | [diff] [blame] | 1669 | static int ieee80211_update_mesh_config(struct wiphy *wiphy, |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 1670 | struct net_device *dev, u32 mask, |
| 1671 | const struct mesh_config *nconf) |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1672 | { |
| 1673 | struct mesh_config *conf; |
| 1674 | struct ieee80211_sub_if_data *sdata; |
Rui Paulo | 63c5723 | 2009-11-09 23:46:57 +0000 | [diff] [blame] | 1675 | struct ieee80211_if_mesh *ifmsh; |
| 1676 | |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1677 | sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Rui Paulo | 63c5723 | 2009-11-09 23:46:57 +0000 | [diff] [blame] | 1678 | ifmsh = &sdata->u.mesh; |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1679 | |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1680 | /* Set the config options which we are interested in setting */ |
| 1681 | conf = &(sdata->u.mesh.mshcfg); |
| 1682 | if (_chg_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask)) |
| 1683 | conf->dot11MeshRetryTimeout = nconf->dot11MeshRetryTimeout; |
| 1684 | if (_chg_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask)) |
| 1685 | conf->dot11MeshConfirmTimeout = nconf->dot11MeshConfirmTimeout; |
| 1686 | if (_chg_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask)) |
| 1687 | conf->dot11MeshHoldingTimeout = nconf->dot11MeshHoldingTimeout; |
| 1688 | if (_chg_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask)) |
| 1689 | conf->dot11MeshMaxPeerLinks = nconf->dot11MeshMaxPeerLinks; |
| 1690 | if (_chg_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask)) |
| 1691 | conf->dot11MeshMaxRetries = nconf->dot11MeshMaxRetries; |
| 1692 | if (_chg_mesh_attr(NL80211_MESHCONF_TTL, mask)) |
| 1693 | conf->dot11MeshTTL = nconf->dot11MeshTTL; |
Javier Cardona | 45904f2 | 2010-12-03 09:20:40 +0100 | [diff] [blame] | 1694 | if (_chg_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask)) |
Chun-Yeow Yeoh | 58886a9 | 2012-06-15 00:23:53 +0800 | [diff] [blame] | 1695 | conf->element_ttl = nconf->element_ttl; |
Thomas Pedersen | 146bb48 | 2013-03-04 13:06:14 -0800 | [diff] [blame] | 1696 | if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)) { |
| 1697 | if (ifmsh->user_mpm) |
| 1698 | return -EBUSY; |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1699 | conf->auto_open_plinks = nconf->auto_open_plinks; |
Thomas Pedersen | 146bb48 | 2013-03-04 13:06:14 -0800 | [diff] [blame] | 1700 | } |
Javier Cardona | d299a1f | 2012-03-31 11:31:33 -0700 | [diff] [blame] | 1701 | if (_chg_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask)) |
| 1702 | conf->dot11MeshNbrOffsetMaxNeighbor = |
| 1703 | nconf->dot11MeshNbrOffsetMaxNeighbor; |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1704 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask)) |
| 1705 | conf->dot11MeshHWMPmaxPREQretries = |
| 1706 | nconf->dot11MeshHWMPmaxPREQretries; |
| 1707 | if (_chg_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask)) |
| 1708 | conf->path_refresh_time = nconf->path_refresh_time; |
| 1709 | if (_chg_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask)) |
| 1710 | conf->min_discovery_timeout = nconf->min_discovery_timeout; |
| 1711 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask)) |
| 1712 | conf->dot11MeshHWMPactivePathTimeout = |
| 1713 | nconf->dot11MeshHWMPactivePathTimeout; |
| 1714 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask)) |
| 1715 | conf->dot11MeshHWMPpreqMinInterval = |
| 1716 | nconf->dot11MeshHWMPpreqMinInterval; |
Thomas Pedersen | dca7e94 | 2011-11-24 17:15:24 -0800 | [diff] [blame] | 1717 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask)) |
| 1718 | conf->dot11MeshHWMPperrMinInterval = |
| 1719 | nconf->dot11MeshHWMPperrMinInterval; |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1720 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME, |
| 1721 | mask)) |
| 1722 | conf->dot11MeshHWMPnetDiameterTraversalTime = |
| 1723 | nconf->dot11MeshHWMPnetDiameterTraversalTime; |
Rui Paulo | 63c5723 | 2009-11-09 23:46:57 +0000 | [diff] [blame] | 1724 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) { |
| 1725 | conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode; |
| 1726 | ieee80211_mesh_root_setup(ifmsh); |
| 1727 | } |
Javier Cardona | 16dd726 | 2011-08-09 16:45:11 -0700 | [diff] [blame] | 1728 | if (_chg_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) { |
Thomas Pedersen | c6133661 | 2011-08-25 10:36:14 -0700 | [diff] [blame] | 1729 | /* our current gate announcement implementation rides on root |
| 1730 | * announcements, so require this ifmsh to also be a root node |
| 1731 | * */ |
| 1732 | if (nconf->dot11MeshGateAnnouncementProtocol && |
Chun-Yeow Yeoh | dbb912c | 2012-06-14 02:06:09 +0800 | [diff] [blame] | 1733 | !(conf->dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT)) { |
| 1734 | conf->dot11MeshHWMPRootMode = IEEE80211_PROACTIVE_RANN; |
Thomas Pedersen | c6133661 | 2011-08-25 10:36:14 -0700 | [diff] [blame] | 1735 | ieee80211_mesh_root_setup(ifmsh); |
| 1736 | } |
Javier Cardona | 16dd726 | 2011-08-09 16:45:11 -0700 | [diff] [blame] | 1737 | conf->dot11MeshGateAnnouncementProtocol = |
| 1738 | nconf->dot11MeshGateAnnouncementProtocol; |
| 1739 | } |
Chun-Yeow Yeoh | a4f606e | 2012-06-11 11:59:36 +0800 | [diff] [blame] | 1740 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask)) |
Javier Cardona | 0507e15 | 2011-08-09 16:45:10 -0700 | [diff] [blame] | 1741 | conf->dot11MeshHWMPRannInterval = |
| 1742 | nconf->dot11MeshHWMPRannInterval; |
Chun-Yeow Yeoh | 94f9065 | 2012-01-21 01:02:16 +0800 | [diff] [blame] | 1743 | if (_chg_mesh_attr(NL80211_MESHCONF_FORWARDING, mask)) |
| 1744 | conf->dot11MeshForwarding = nconf->dot11MeshForwarding; |
Ashok Nagarajan | 5533513 | 2012-02-28 17:04:08 -0800 | [diff] [blame] | 1745 | if (_chg_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) { |
| 1746 | /* our RSSI threshold implementation is supported only for |
| 1747 | * devices that report signal in dBm. |
| 1748 | */ |
Johannes Berg | 30686bf | 2015-06-02 21:39:54 +0200 | [diff] [blame] | 1749 | if (!ieee80211_hw_check(&sdata->local->hw, SIGNAL_DBM)) |
Ashok Nagarajan | 5533513 | 2012-02-28 17:04:08 -0800 | [diff] [blame] | 1750 | return -ENOTSUPP; |
| 1751 | conf->rssi_threshold = nconf->rssi_threshold; |
| 1752 | } |
Ashok Nagarajan | 70c33ea | 2012-04-30 14:20:32 -0700 | [diff] [blame] | 1753 | if (_chg_mesh_attr(NL80211_MESHCONF_HT_OPMODE, mask)) { |
| 1754 | conf->ht_opmode = nconf->ht_opmode; |
| 1755 | sdata->vif.bss_conf.ht_operation_mode = nconf->ht_opmode; |
| 1756 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_HT); |
| 1757 | } |
Chun-Yeow Yeoh | ac1073a | 2012-06-14 02:06:06 +0800 | [diff] [blame] | 1758 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, mask)) |
| 1759 | conf->dot11MeshHWMPactivePathToRootTimeout = |
| 1760 | nconf->dot11MeshHWMPactivePathToRootTimeout; |
| 1761 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOT_INTERVAL, mask)) |
| 1762 | conf->dot11MeshHWMProotInterval = |
| 1763 | nconf->dot11MeshHWMProotInterval; |
Chun-Yeow Yeoh | 728b19e | 2012-06-14 02:06:10 +0800 | [diff] [blame] | 1764 | if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask)) |
| 1765 | conf->dot11MeshHWMPconfirmationInterval = |
| 1766 | nconf->dot11MeshHWMPconfirmationInterval; |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 1767 | if (_chg_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)) { |
| 1768 | conf->power_mode = nconf->power_mode; |
| 1769 | ieee80211_mps_local_status_update(sdata); |
| 1770 | } |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 1771 | if (_chg_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask)) |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 1772 | conf->dot11MeshAwakeWindowDuration = |
| 1773 | nconf->dot11MeshAwakeWindowDuration; |
Colleen Twitty | 66de671 | 2013-06-03 09:53:40 -0700 | [diff] [blame] | 1774 | if (_chg_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask)) |
| 1775 | conf->plink_timeout = nconf->plink_timeout; |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 1776 | ieee80211_mbss_info_change_notify(sdata, BSS_CHANGED_BEACON); |
colin@cozybit.com | 93da9cc | 2008-10-21 12:03:48 -0700 | [diff] [blame] | 1777 | return 0; |
| 1778 | } |
| 1779 | |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 1780 | static int ieee80211_join_mesh(struct wiphy *wiphy, struct net_device *dev, |
| 1781 | const struct mesh_config *conf, |
| 1782 | const struct mesh_setup *setup) |
| 1783 | { |
| 1784 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1785 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1786 | int err; |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 1787 | |
Javier Cardona | c80d545 | 2010-12-16 17:37:49 -0800 | [diff] [blame] | 1788 | memcpy(&ifmsh->mshcfg, conf, sizeof(struct mesh_config)); |
| 1789 | err = copy_mesh_setup(ifmsh, setup); |
| 1790 | if (err) |
| 1791 | return err; |
Johannes Berg | cc1d280 | 2012-05-16 23:50:20 +0200 | [diff] [blame] | 1792 | |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 1793 | /* can mesh use other SMPS modes? */ |
| 1794 | sdata->smps_mode = IEEE80211_SMPS_OFF; |
| 1795 | sdata->needed_rx_chains = sdata->local->rx_chains; |
| 1796 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1797 | mutex_lock(&sdata->local->mtx); |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 1798 | err = ieee80211_vif_use_channel(sdata, &setup->chandef, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1799 | IEEE80211_CHANCTX_SHARED); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1800 | mutex_unlock(&sdata->local->mtx); |
Johannes Berg | cc1d280 | 2012-05-16 23:50:20 +0200 | [diff] [blame] | 1801 | if (err) |
| 1802 | return err; |
| 1803 | |
Thomas Pedersen | 2b5e196 | 2013-02-14 11:20:13 -0800 | [diff] [blame] | 1804 | return ieee80211_start_mesh(sdata); |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 1805 | } |
| 1806 | |
| 1807 | static int ieee80211_leave_mesh(struct wiphy *wiphy, struct net_device *dev) |
| 1808 | { |
| 1809 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1810 | |
| 1811 | ieee80211_stop_mesh(sdata); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1812 | mutex_lock(&sdata->local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1813 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1814 | mutex_unlock(&sdata->local->mtx); |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 1815 | |
| 1816 | return 0; |
| 1817 | } |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 1818 | #endif |
| 1819 | |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1820 | static int ieee80211_change_bss(struct wiphy *wiphy, |
| 1821 | struct net_device *dev, |
| 1822 | struct bss_parameters *params) |
| 1823 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1824 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 1825 | enum ieee80211_band band; |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1826 | u32 changed = 0; |
| 1827 | |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 1828 | if (!sdata_dereference(sdata->u.ap.beacon, sdata)) |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1829 | return -ENOENT; |
| 1830 | |
| 1831 | band = ieee80211_get_sdata_band(sdata); |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1832 | |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1833 | if (params->use_cts_prot >= 0) { |
Johannes Berg | bda3933 | 2008-10-11 01:51:51 +0200 | [diff] [blame] | 1834 | sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot; |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1835 | changed |= BSS_CHANGED_ERP_CTS_PROT; |
| 1836 | } |
| 1837 | if (params->use_short_preamble >= 0) { |
Johannes Berg | bda3933 | 2008-10-11 01:51:51 +0200 | [diff] [blame] | 1838 | sdata->vif.bss_conf.use_short_preamble = |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1839 | params->use_short_preamble; |
| 1840 | changed |= BSS_CHANGED_ERP_PREAMBLE; |
| 1841 | } |
Felix Fietkau | 43d3534 | 2010-01-15 03:00:48 +0100 | [diff] [blame] | 1842 | |
| 1843 | if (!sdata->vif.bss_conf.use_short_slot && |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1844 | band == IEEE80211_BAND_5GHZ) { |
Felix Fietkau | 43d3534 | 2010-01-15 03:00:48 +0100 | [diff] [blame] | 1845 | sdata->vif.bss_conf.use_short_slot = true; |
| 1846 | changed |= BSS_CHANGED_ERP_SLOT; |
| 1847 | } |
| 1848 | |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1849 | if (params->use_short_slot_time >= 0) { |
Johannes Berg | bda3933 | 2008-10-11 01:51:51 +0200 | [diff] [blame] | 1850 | sdata->vif.bss_conf.use_short_slot = |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1851 | params->use_short_slot_time; |
| 1852 | changed |= BSS_CHANGED_ERP_SLOT; |
| 1853 | } |
| 1854 | |
Jouni Malinen | 90c97a0 | 2008-10-30 16:59:22 +0200 | [diff] [blame] | 1855 | if (params->basic_rates) { |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 1856 | ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef, |
| 1857 | wiphy->bands[band], |
| 1858 | params->basic_rates, |
| 1859 | params->basic_rates_len, |
| 1860 | &sdata->vif.bss_conf.basic_rates); |
Jouni Malinen | 90c97a0 | 2008-10-30 16:59:22 +0200 | [diff] [blame] | 1861 | changed |= BSS_CHANGED_BASIC_RATES; |
| 1862 | } |
| 1863 | |
Felix Fietkau | 7b7b5e5 | 2010-04-27 01:23:36 +0200 | [diff] [blame] | 1864 | if (params->ap_isolate >= 0) { |
| 1865 | if (params->ap_isolate) |
| 1866 | sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS; |
| 1867 | else |
| 1868 | sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS; |
| 1869 | } |
| 1870 | |
Helmut Schaa | 80d7e40 | 2010-11-19 12:40:26 +0100 | [diff] [blame] | 1871 | if (params->ht_opmode >= 0) { |
| 1872 | sdata->vif.bss_conf.ht_operation_mode = |
| 1873 | (u16) params->ht_opmode; |
| 1874 | changed |= BSS_CHANGED_HT; |
| 1875 | } |
| 1876 | |
Johannes Berg | 339afbf | 2012-11-14 15:21:17 +0100 | [diff] [blame] | 1877 | if (params->p2p_ctwindow >= 0) { |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 1878 | sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &= |
| 1879 | ~IEEE80211_P2P_OPPPS_CTWINDOW_MASK; |
| 1880 | sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |= |
| 1881 | params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK; |
Johannes Berg | 339afbf | 2012-11-14 15:21:17 +0100 | [diff] [blame] | 1882 | changed |= BSS_CHANGED_P2P_PS; |
| 1883 | } |
| 1884 | |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 1885 | if (params->p2p_opp_ps > 0) { |
| 1886 | sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |= |
| 1887 | IEEE80211_P2P_OPPPS_ENABLE_BIT; |
| 1888 | changed |= BSS_CHANGED_P2P_PS; |
| 1889 | } else if (params->p2p_opp_ps == 0) { |
| 1890 | sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &= |
| 1891 | ~IEEE80211_P2P_OPPPS_ENABLE_BIT; |
Johannes Berg | 339afbf | 2012-11-14 15:21:17 +0100 | [diff] [blame] | 1892 | changed |= BSS_CHANGED_P2P_PS; |
| 1893 | } |
| 1894 | |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 1895 | ieee80211_bss_info_change_notify(sdata, changed); |
| 1896 | |
| 1897 | return 0; |
| 1898 | } |
| 1899 | |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 1900 | static int ieee80211_set_txq_params(struct wiphy *wiphy, |
Eliad Peller | f70f01c | 2011-09-25 20:06:53 +0300 | [diff] [blame] | 1901 | struct net_device *dev, |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 1902 | struct ieee80211_txq_params *params) |
| 1903 | { |
| 1904 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Eliad Peller | f6f3def | 2011-09-25 20:06:54 +0300 | [diff] [blame] | 1905 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 1906 | struct ieee80211_tx_queue_params p; |
| 1907 | |
| 1908 | if (!local->ops->conf_tx) |
| 1909 | return -EOPNOTSUPP; |
| 1910 | |
Johannes Berg | 54bcbc6 | 2012-03-28 11:04:25 +0200 | [diff] [blame] | 1911 | if (local->hw.queues < IEEE80211_NUM_ACS) |
| 1912 | return -EOPNOTSUPP; |
| 1913 | |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 1914 | memset(&p, 0, sizeof(p)); |
| 1915 | p.aifs = params->aifs; |
| 1916 | p.cw_max = params->cwmax; |
| 1917 | p.cw_min = params->cwmin; |
| 1918 | p.txop = params->txop; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1919 | |
| 1920 | /* |
| 1921 | * Setting tx queue params disables u-apsd because it's only |
| 1922 | * called in master mode. |
| 1923 | */ |
| 1924 | p.uapsd = false; |
| 1925 | |
Johannes Berg | a3304b0 | 2012-03-28 11:04:24 +0200 | [diff] [blame] | 1926 | sdata->tx_conf[params->ac] = p; |
| 1927 | if (drv_conf_tx(local, sdata, params->ac, &p)) { |
Joe Perches | 0fb9a9e | 2010-08-20 16:25:38 -0700 | [diff] [blame] | 1928 | wiphy_debug(local->hw.wiphy, |
Johannes Berg | a3304b0 | 2012-03-28 11:04:24 +0200 | [diff] [blame] | 1929 | "failed to set TX queue parameters for AC %d\n", |
| 1930 | params->ac); |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 1931 | return -EINVAL; |
| 1932 | } |
| 1933 | |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1934 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS); |
| 1935 | |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 1936 | return 0; |
| 1937 | } |
| 1938 | |
Bob Copeland | 665af4f | 2009-01-19 11:20:53 -0500 | [diff] [blame] | 1939 | #ifdef CONFIG_PM |
Johannes Berg | ff1b6e6 | 2011-05-04 15:37:28 +0200 | [diff] [blame] | 1940 | static int ieee80211_suspend(struct wiphy *wiphy, |
| 1941 | struct cfg80211_wowlan *wowlan) |
Bob Copeland | 665af4f | 2009-01-19 11:20:53 -0500 | [diff] [blame] | 1942 | { |
Johannes Berg | eecc480 | 2011-05-04 15:37:29 +0200 | [diff] [blame] | 1943 | return __ieee80211_suspend(wiphy_priv(wiphy), wowlan); |
Bob Copeland | 665af4f | 2009-01-19 11:20:53 -0500 | [diff] [blame] | 1944 | } |
| 1945 | |
| 1946 | static int ieee80211_resume(struct wiphy *wiphy) |
| 1947 | { |
| 1948 | return __ieee80211_resume(wiphy_priv(wiphy)); |
| 1949 | } |
| 1950 | #else |
| 1951 | #define ieee80211_suspend NULL |
| 1952 | #define ieee80211_resume NULL |
| 1953 | #endif |
| 1954 | |
Johannes Berg | 2a51931 | 2009-02-10 21:25:55 +0100 | [diff] [blame] | 1955 | static int ieee80211_scan(struct wiphy *wiphy, |
Johannes Berg | 2a51931 | 2009-02-10 21:25:55 +0100 | [diff] [blame] | 1956 | struct cfg80211_scan_request *req) |
| 1957 | { |
Johannes Berg | fd01428 | 2012-06-18 19:17:03 +0200 | [diff] [blame] | 1958 | struct ieee80211_sub_if_data *sdata; |
| 1959 | |
| 1960 | sdata = IEEE80211_WDEV_TO_SUB_IF(req->wdev); |
Johannes Berg | 2a51931 | 2009-02-10 21:25:55 +0100 | [diff] [blame] | 1961 | |
Johannes Berg | 2ca27bc | 2010-09-16 14:58:23 +0200 | [diff] [blame] | 1962 | switch (ieee80211_vif_type_p2p(&sdata->vif)) { |
| 1963 | case NL80211_IFTYPE_STATION: |
| 1964 | case NL80211_IFTYPE_ADHOC: |
| 1965 | case NL80211_IFTYPE_MESH_POINT: |
| 1966 | case NL80211_IFTYPE_P2P_CLIENT: |
Johannes Berg | f142c6b | 2012-06-18 20:07:15 +0200 | [diff] [blame] | 1967 | case NL80211_IFTYPE_P2P_DEVICE: |
Johannes Berg | 2ca27bc | 2010-09-16 14:58:23 +0200 | [diff] [blame] | 1968 | break; |
| 1969 | case NL80211_IFTYPE_P2P_GO: |
| 1970 | if (sdata->local->ops->hw_scan) |
| 1971 | break; |
Johannes Berg | e9d7732 | 2011-02-01 15:35:36 +0100 | [diff] [blame] | 1972 | /* |
| 1973 | * FIXME: implement NoA while scanning in software, |
| 1974 | * for now fall through to allow scanning only when |
| 1975 | * beaconing hasn't been configured yet |
| 1976 | */ |
Johannes Berg | 2ca27bc | 2010-09-16 14:58:23 +0200 | [diff] [blame] | 1977 | case NL80211_IFTYPE_AP: |
Antonio Quartulli | 5c95b94 | 2012-10-16 08:39:22 +0200 | [diff] [blame] | 1978 | /* |
| 1979 | * If the scan has been forced (and the driver supports |
| 1980 | * forcing), don't care about being beaconing already. |
| 1981 | * This will create problems to the attached stations (e.g. all |
| 1982 | * the frames sent while scanning on other channel will be |
| 1983 | * lost) |
| 1984 | */ |
| 1985 | if (sdata->u.ap.beacon && |
| 1986 | (!(wiphy->features & NL80211_FEATURE_AP_SCAN) || |
| 1987 | !(req->flags & NL80211_SCAN_FLAG_AP))) |
Johannes Berg | 2ca27bc | 2010-09-16 14:58:23 +0200 | [diff] [blame] | 1988 | return -EOPNOTSUPP; |
| 1989 | break; |
| 1990 | default: |
| 1991 | return -EOPNOTSUPP; |
| 1992 | } |
Johannes Berg | 2a51931 | 2009-02-10 21:25:55 +0100 | [diff] [blame] | 1993 | |
| 1994 | return ieee80211_request_scan(sdata, req); |
| 1995 | } |
| 1996 | |
Luciano Coelho | 79f460c | 2011-05-11 17:09:36 +0300 | [diff] [blame] | 1997 | static int |
| 1998 | ieee80211_sched_scan_start(struct wiphy *wiphy, |
| 1999 | struct net_device *dev, |
| 2000 | struct cfg80211_sched_scan_request *req) |
| 2001 | { |
| 2002 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 2003 | |
| 2004 | if (!sdata->local->ops->sched_scan_start) |
| 2005 | return -EOPNOTSUPP; |
| 2006 | |
| 2007 | return ieee80211_request_sched_scan_start(sdata, req); |
| 2008 | } |
| 2009 | |
| 2010 | static int |
Luciano Coelho | 85a9994 | 2011-05-12 16:28:29 +0300 | [diff] [blame] | 2011 | ieee80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev) |
Luciano Coelho | 79f460c | 2011-05-11 17:09:36 +0300 | [diff] [blame] | 2012 | { |
Eliad Peller | 0d440ea | 2015-10-25 10:59:33 +0200 | [diff] [blame] | 2013 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Luciano Coelho | 79f460c | 2011-05-11 17:09:36 +0300 | [diff] [blame] | 2014 | |
Eliad Peller | 0d440ea | 2015-10-25 10:59:33 +0200 | [diff] [blame] | 2015 | if (!local->ops->sched_scan_stop) |
Luciano Coelho | 79f460c | 2011-05-11 17:09:36 +0300 | [diff] [blame] | 2016 | return -EOPNOTSUPP; |
| 2017 | |
Eliad Peller | 0d440ea | 2015-10-25 10:59:33 +0200 | [diff] [blame] | 2018 | return ieee80211_request_sched_scan_stop(local); |
Luciano Coelho | 79f460c | 2011-05-11 17:09:36 +0300 | [diff] [blame] | 2019 | } |
| 2020 | |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2021 | static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev, |
| 2022 | struct cfg80211_auth_request *req) |
| 2023 | { |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2024 | return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req); |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2025 | } |
| 2026 | |
| 2027 | static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev, |
| 2028 | struct cfg80211_assoc_request *req) |
| 2029 | { |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2030 | return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req); |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2031 | } |
| 2032 | |
| 2033 | static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 63c9c5e | 2012-02-24 13:50:51 +0100 | [diff] [blame] | 2034 | struct cfg80211_deauth_request *req) |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2035 | { |
Johannes Berg | 63c9c5e | 2012-02-24 13:50:51 +0100 | [diff] [blame] | 2036 | return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev), req); |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2037 | } |
| 2038 | |
| 2039 | static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 63c9c5e | 2012-02-24 13:50:51 +0100 | [diff] [blame] | 2040 | struct cfg80211_disassoc_request *req) |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2041 | { |
Johannes Berg | 63c9c5e | 2012-02-24 13:50:51 +0100 | [diff] [blame] | 2042 | return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev), req); |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 2043 | } |
| 2044 | |
Johannes Berg | af8cdcd | 2009-04-19 21:25:43 +0200 | [diff] [blame] | 2045 | static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev, |
| 2046 | struct cfg80211_ibss_params *params) |
| 2047 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2048 | return ieee80211_ibss_join(IEEE80211_DEV_TO_SUB_IF(dev), params); |
Johannes Berg | af8cdcd | 2009-04-19 21:25:43 +0200 | [diff] [blame] | 2049 | } |
| 2050 | |
| 2051 | static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev) |
| 2052 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2053 | return ieee80211_ibss_leave(IEEE80211_DEV_TO_SUB_IF(dev)); |
Johannes Berg | af8cdcd | 2009-04-19 21:25:43 +0200 | [diff] [blame] | 2054 | } |
| 2055 | |
Rostislav Lisovy | 239281f | 2014-11-03 10:33:19 +0100 | [diff] [blame] | 2056 | static int ieee80211_join_ocb(struct wiphy *wiphy, struct net_device *dev, |
| 2057 | struct ocb_setup *setup) |
| 2058 | { |
| 2059 | return ieee80211_ocb_join(IEEE80211_DEV_TO_SUB_IF(dev), setup); |
| 2060 | } |
| 2061 | |
| 2062 | static int ieee80211_leave_ocb(struct wiphy *wiphy, struct net_device *dev) |
| 2063 | { |
| 2064 | return ieee80211_ocb_leave(IEEE80211_DEV_TO_SUB_IF(dev)); |
| 2065 | } |
| 2066 | |
Antonio Quartulli | 391e53e | 2012-11-02 13:27:49 +0100 | [diff] [blame] | 2067 | static int ieee80211_set_mcast_rate(struct wiphy *wiphy, struct net_device *dev, |
| 2068 | int rate[IEEE80211_NUM_BANDS]) |
| 2069 | { |
| 2070 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 2071 | |
Cong Ding | 9887dbf | 2013-02-06 17:23:45 +0100 | [diff] [blame] | 2072 | memcpy(sdata->vif.bss_conf.mcast_rate, rate, |
| 2073 | sizeof(int) * IEEE80211_NUM_BANDS); |
Antonio Quartulli | 391e53e | 2012-11-02 13:27:49 +0100 | [diff] [blame] | 2074 | |
| 2075 | return 0; |
| 2076 | } |
| 2077 | |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2078 | static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed) |
| 2079 | { |
| 2080 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 2448798 | 2009-04-23 18:52:52 +0200 | [diff] [blame] | 2081 | int err; |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2082 | |
Arik Nemtsov | f23a478 | 2010-11-08 11:51:06 +0200 | [diff] [blame] | 2083 | if (changed & WIPHY_PARAM_FRAG_THRESHOLD) { |
Johannes Berg | 17c18bf | 2015-03-21 15:25:43 +0100 | [diff] [blame] | 2084 | ieee80211_check_fast_xmit_all(local); |
| 2085 | |
Arik Nemtsov | f23a478 | 2010-11-08 11:51:06 +0200 | [diff] [blame] | 2086 | err = drv_set_frag_threshold(local, wiphy->frag_threshold); |
| 2087 | |
Johannes Berg | 17c18bf | 2015-03-21 15:25:43 +0100 | [diff] [blame] | 2088 | if (err) { |
| 2089 | ieee80211_check_fast_xmit_all(local); |
Arik Nemtsov | f23a478 | 2010-11-08 11:51:06 +0200 | [diff] [blame] | 2090 | return err; |
Johannes Berg | 17c18bf | 2015-03-21 15:25:43 +0100 | [diff] [blame] | 2091 | } |
Arik Nemtsov | f23a478 | 2010-11-08 11:51:06 +0200 | [diff] [blame] | 2092 | } |
| 2093 | |
Lorenzo Bianconi | a4bcaf5 | 2014-09-04 23:57:41 +0200 | [diff] [blame] | 2094 | if ((changed & WIPHY_PARAM_COVERAGE_CLASS) || |
| 2095 | (changed & WIPHY_PARAM_DYN_ACK)) { |
| 2096 | s16 coverage_class; |
| 2097 | |
| 2098 | coverage_class = changed & WIPHY_PARAM_COVERAGE_CLASS ? |
| 2099 | wiphy->coverage_class : -1; |
| 2100 | err = drv_set_coverage_class(local, coverage_class); |
Lukáš Turek | 310bc67 | 2009-12-21 22:50:48 +0100 | [diff] [blame] | 2101 | |
| 2102 | if (err) |
| 2103 | return err; |
| 2104 | } |
| 2105 | |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2106 | if (changed & WIPHY_PARAM_RTS_THRESHOLD) { |
Johannes Berg | 2448798 | 2009-04-23 18:52:52 +0200 | [diff] [blame] | 2107 | err = drv_set_rts_threshold(local, wiphy->rts_threshold); |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2108 | |
Johannes Berg | 2448798 | 2009-04-23 18:52:52 +0200 | [diff] [blame] | 2109 | if (err) |
| 2110 | return err; |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2111 | } |
| 2112 | |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 2113 | if (changed & WIPHY_PARAM_RETRY_SHORT) { |
| 2114 | if (wiphy->retry_short > IEEE80211_MAX_TX_RETRY) |
| 2115 | return -EINVAL; |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2116 | local->hw.conf.short_frame_max_tx_count = wiphy->retry_short; |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 2117 | } |
| 2118 | if (changed & WIPHY_PARAM_RETRY_LONG) { |
| 2119 | if (wiphy->retry_long > IEEE80211_MAX_TX_RETRY) |
| 2120 | return -EINVAL; |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2121 | local->hw.conf.long_frame_max_tx_count = wiphy->retry_long; |
Johannes Berg | 8bc83c2 | 2012-11-09 18:38:32 +0100 | [diff] [blame] | 2122 | } |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 2123 | if (changed & |
| 2124 | (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG)) |
| 2125 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS); |
| 2126 | |
| 2127 | return 0; |
| 2128 | } |
| 2129 | |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2130 | static int ieee80211_set_tx_power(struct wiphy *wiphy, |
Johannes Berg | c844211 | 2012-10-24 10:17:18 +0200 | [diff] [blame] | 2131 | struct wireless_dev *wdev, |
Juuso Oikarinen | fa61cf7 | 2010-06-23 12:12:37 +0300 | [diff] [blame] | 2132 | enum nl80211_tx_power_setting type, int mbm) |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2133 | { |
| 2134 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2135 | struct ieee80211_sub_if_data *sdata; |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2136 | enum nl80211_tx_power_setting txp_type = type; |
| 2137 | bool update_txp_type = false; |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2138 | |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2139 | if (wdev) { |
| 2140 | sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
| 2141 | |
| 2142 | switch (type) { |
| 2143 | case NL80211_TX_POWER_AUTOMATIC: |
| 2144 | sdata->user_power_level = IEEE80211_UNSET_POWER_LEVEL; |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2145 | txp_type = NL80211_TX_POWER_LIMITED; |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2146 | break; |
| 2147 | case NL80211_TX_POWER_LIMITED: |
| 2148 | case NL80211_TX_POWER_FIXED: |
| 2149 | if (mbm < 0 || (mbm % 100)) |
| 2150 | return -EOPNOTSUPP; |
| 2151 | sdata->user_power_level = MBM_TO_DBM(mbm); |
| 2152 | break; |
| 2153 | } |
| 2154 | |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2155 | if (txp_type != sdata->vif.bss_conf.txpower_type) { |
| 2156 | update_txp_type = true; |
| 2157 | sdata->vif.bss_conf.txpower_type = txp_type; |
| 2158 | } |
| 2159 | |
| 2160 | ieee80211_recalc_txpower(sdata, update_txp_type); |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2161 | |
| 2162 | return 0; |
| 2163 | } |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2164 | |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2165 | switch (type) { |
Juuso Oikarinen | fa61cf7 | 2010-06-23 12:12:37 +0300 | [diff] [blame] | 2166 | case NL80211_TX_POWER_AUTOMATIC: |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2167 | local->user_power_level = IEEE80211_UNSET_POWER_LEVEL; |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2168 | txp_type = NL80211_TX_POWER_LIMITED; |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2169 | break; |
Juuso Oikarinen | fa61cf7 | 2010-06-23 12:12:37 +0300 | [diff] [blame] | 2170 | case NL80211_TX_POWER_LIMITED: |
Juuso Oikarinen | fa61cf7 | 2010-06-23 12:12:37 +0300 | [diff] [blame] | 2171 | case NL80211_TX_POWER_FIXED: |
| 2172 | if (mbm < 0 || (mbm % 100)) |
| 2173 | return -EOPNOTSUPP; |
Juuso Oikarinen | fa61cf7 | 2010-06-23 12:12:37 +0300 | [diff] [blame] | 2174 | local->user_power_level = MBM_TO_DBM(mbm); |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2175 | break; |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2176 | } |
| 2177 | |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2178 | mutex_lock(&local->iflist_mtx); |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2179 | list_for_each_entry(sdata, &local->interfaces, list) { |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2180 | sdata->user_power_level = local->user_power_level; |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2181 | if (txp_type != sdata->vif.bss_conf.txpower_type) |
| 2182 | update_txp_type = true; |
| 2183 | sdata->vif.bss_conf.txpower_type = txp_type; |
| 2184 | } |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2185 | list_for_each_entry(sdata, &local->interfaces, list) |
Lorenzo Bianconi | db82d8a | 2015-01-14 12:55:08 +0100 | [diff] [blame] | 2186 | ieee80211_recalc_txpower(sdata, update_txp_type); |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2187 | mutex_unlock(&local->iflist_mtx); |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2188 | |
| 2189 | return 0; |
| 2190 | } |
| 2191 | |
Johannes Berg | c844211 | 2012-10-24 10:17:18 +0200 | [diff] [blame] | 2192 | static int ieee80211_get_tx_power(struct wiphy *wiphy, |
| 2193 | struct wireless_dev *wdev, |
| 2194 | int *dbm) |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2195 | { |
| 2196 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2197 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2198 | |
Felix Fietkau | 5b3dc42 | 2014-10-26 00:32:53 +0200 | [diff] [blame] | 2199 | if (local->ops->get_txpower) |
| 2200 | return drv_get_txpower(local, sdata, dbm); |
| 2201 | |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 2202 | if (!local->use_chanctx) |
| 2203 | *dbm = local->hw.conf.power_level; |
| 2204 | else |
| 2205 | *dbm = sdata->vif.bss_conf.txpower; |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2206 | |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 2207 | return 0; |
| 2208 | } |
| 2209 | |
Johannes Berg | ab737a4 | 2009-07-01 21:26:58 +0200 | [diff] [blame] | 2210 | static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev, |
Johannes Berg | 388ac77 | 2010-10-07 13:11:09 +0200 | [diff] [blame] | 2211 | const u8 *addr) |
Johannes Berg | ab737a4 | 2009-07-01 21:26:58 +0200 | [diff] [blame] | 2212 | { |
| 2213 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 2214 | |
| 2215 | memcpy(&sdata->u.wds.remote_addr, addr, ETH_ALEN); |
| 2216 | |
| 2217 | return 0; |
| 2218 | } |
| 2219 | |
Johannes Berg | 1f87f7d | 2009-06-02 13:01:41 +0200 | [diff] [blame] | 2220 | static void ieee80211_rfkill_poll(struct wiphy *wiphy) |
| 2221 | { |
| 2222 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 2223 | |
| 2224 | drv_rfkill_poll(local); |
| 2225 | } |
| 2226 | |
Johannes Berg | aff89a9 | 2009-07-01 21:26:51 +0200 | [diff] [blame] | 2227 | #ifdef CONFIG_NL80211_TESTMODE |
David Spinadel | fc73f11 | 2013-07-31 18:04:15 +0300 | [diff] [blame] | 2228 | static int ieee80211_testmode_cmd(struct wiphy *wiphy, |
| 2229 | struct wireless_dev *wdev, |
| 2230 | void *data, int len) |
Johannes Berg | aff89a9 | 2009-07-01 21:26:51 +0200 | [diff] [blame] | 2231 | { |
| 2232 | struct ieee80211_local *local = wiphy_priv(wiphy); |
David Spinadel | 52981cd | 2013-07-31 18:06:22 +0300 | [diff] [blame] | 2233 | struct ieee80211_vif *vif = NULL; |
Johannes Berg | aff89a9 | 2009-07-01 21:26:51 +0200 | [diff] [blame] | 2234 | |
| 2235 | if (!local->ops->testmode_cmd) |
| 2236 | return -EOPNOTSUPP; |
| 2237 | |
David Spinadel | 52981cd | 2013-07-31 18:06:22 +0300 | [diff] [blame] | 2238 | if (wdev) { |
| 2239 | struct ieee80211_sub_if_data *sdata; |
| 2240 | |
| 2241 | sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
| 2242 | if (sdata->flags & IEEE80211_SDATA_IN_DRIVER) |
| 2243 | vif = &sdata->vif; |
| 2244 | } |
| 2245 | |
| 2246 | return local->ops->testmode_cmd(&local->hw, vif, data, len); |
Johannes Berg | aff89a9 | 2009-07-01 21:26:51 +0200 | [diff] [blame] | 2247 | } |
Wey-Yi Guy | 71063f0 | 2011-05-20 09:05:54 -0700 | [diff] [blame] | 2248 | |
| 2249 | static int ieee80211_testmode_dump(struct wiphy *wiphy, |
| 2250 | struct sk_buff *skb, |
| 2251 | struct netlink_callback *cb, |
| 2252 | void *data, int len) |
| 2253 | { |
| 2254 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 2255 | |
| 2256 | if (!local->ops->testmode_dump) |
| 2257 | return -EOPNOTSUPP; |
| 2258 | |
| 2259 | return local->ops->testmode_dump(&local->hw, skb, cb, data, len); |
| 2260 | } |
Johannes Berg | aff89a9 | 2009-07-01 21:26:51 +0200 | [diff] [blame] | 2261 | #endif |
| 2262 | |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2263 | int __ieee80211_request_smps_ap(struct ieee80211_sub_if_data *sdata, |
| 2264 | enum ieee80211_smps_mode smps_mode) |
| 2265 | { |
| 2266 | struct sta_info *sta; |
| 2267 | enum ieee80211_smps_mode old_req; |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2268 | |
| 2269 | if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_AP)) |
| 2270 | return -EINVAL; |
| 2271 | |
| 2272 | if (sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT) |
| 2273 | return 0; |
| 2274 | |
| 2275 | old_req = sdata->u.ap.req_smps; |
| 2276 | sdata->u.ap.req_smps = smps_mode; |
| 2277 | |
| 2278 | /* AUTOMATIC doesn't mean much for AP - don't allow it */ |
| 2279 | if (old_req == smps_mode || |
| 2280 | smps_mode == IEEE80211_SMPS_AUTOMATIC) |
| 2281 | return 0; |
| 2282 | |
| 2283 | /* If no associated stations, there's no need to do anything */ |
| 2284 | if (!atomic_read(&sdata->u.ap.num_mcast_sta)) { |
| 2285 | sdata->smps_mode = smps_mode; |
| 2286 | ieee80211_queue_work(&sdata->local->hw, &sdata->recalc_smps); |
| 2287 | return 0; |
| 2288 | } |
| 2289 | |
| 2290 | ht_dbg(sdata, |
Michael Braun | 6a8b4ad | 2015-03-18 07:17:37 +0100 | [diff] [blame] | 2291 | "SMPS %d requested in AP mode, sending Action frame to %d stations\n", |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2292 | smps_mode, atomic_read(&sdata->u.ap.num_mcast_sta)); |
| 2293 | |
| 2294 | mutex_lock(&sdata->local->sta_mtx); |
Johannes Berg | 7d9bb2f | 2015-02-13 21:31:07 +0100 | [diff] [blame] | 2295 | list_for_each_entry(sta, &sdata->local->sta_list, list) { |
| 2296 | /* |
| 2297 | * Only stations associated to our AP and |
| 2298 | * associated VLANs |
| 2299 | */ |
| 2300 | if (sta->sdata->bss != &sdata->u.ap) |
| 2301 | continue; |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2302 | |
Johannes Berg | 7d9bb2f | 2015-02-13 21:31:07 +0100 | [diff] [blame] | 2303 | /* This station doesn't support MIMO - skip it */ |
| 2304 | if (sta_info_tx_streams(sta) == 1) |
| 2305 | continue; |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2306 | |
Johannes Berg | 7d9bb2f | 2015-02-13 21:31:07 +0100 | [diff] [blame] | 2307 | /* |
| 2308 | * Don't wake up a STA just to send the action frame |
| 2309 | * unless we are getting more restrictive. |
| 2310 | */ |
| 2311 | if (test_sta_flag(sta, WLAN_STA_PS_STA) && |
| 2312 | !ieee80211_smps_is_restrictive(sta->known_smps_mode, |
| 2313 | smps_mode)) { |
| 2314 | ht_dbg(sdata, "Won't send SMPS to sleeping STA %pM\n", |
| 2315 | sta->sta.addr); |
| 2316 | continue; |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2317 | } |
Johannes Berg | 7d9bb2f | 2015-02-13 21:31:07 +0100 | [diff] [blame] | 2318 | |
| 2319 | /* |
| 2320 | * If the STA is not authorized, wait until it gets |
| 2321 | * authorized and the action frame will be sent then. |
| 2322 | */ |
| 2323 | if (!test_sta_flag(sta, WLAN_STA_AUTHORIZED)) |
| 2324 | continue; |
| 2325 | |
| 2326 | ht_dbg(sdata, "Sending SMPS to %pM\n", sta->sta.addr); |
| 2327 | ieee80211_send_smps_action(sdata, smps_mode, sta->sta.addr, |
| 2328 | sdata->vif.bss_conf.bssid); |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2329 | } |
| 2330 | mutex_unlock(&sdata->local->sta_mtx); |
| 2331 | |
| 2332 | sdata->smps_mode = smps_mode; |
| 2333 | ieee80211_queue_work(&sdata->local->hw, &sdata->recalc_smps); |
| 2334 | |
| 2335 | return 0; |
| 2336 | } |
| 2337 | |
| 2338 | int __ieee80211_request_smps_mgd(struct ieee80211_sub_if_data *sdata, |
| 2339 | enum ieee80211_smps_mode smps_mode) |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2340 | { |
| 2341 | const u8 *ap; |
| 2342 | enum ieee80211_smps_mode old_req; |
| 2343 | int err; |
Arik Nemtsov | d51c2ea | 2015-06-14 16:53:46 +0300 | [diff] [blame] | 2344 | struct sta_info *sta; |
| 2345 | bool tdls_peer_found = false; |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2346 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2347 | lockdep_assert_held(&sdata->wdev.mtx); |
Johannes Berg | 243e6df | 2011-04-19 20:44:04 +0200 | [diff] [blame] | 2348 | |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2349 | if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_STATION)) |
| 2350 | return -EINVAL; |
| 2351 | |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2352 | old_req = sdata->u.mgd.req_smps; |
| 2353 | sdata->u.mgd.req_smps = smps_mode; |
| 2354 | |
| 2355 | if (old_req == smps_mode && |
| 2356 | smps_mode != IEEE80211_SMPS_AUTOMATIC) |
| 2357 | return 0; |
| 2358 | |
| 2359 | /* |
| 2360 | * If not associated, or current association is not an HT |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 2361 | * association, there's no need to do anything, just store |
| 2362 | * the new value until we associate. |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2363 | */ |
| 2364 | if (!sdata->u.mgd.associated || |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 2365 | sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT) |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2366 | return 0; |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2367 | |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 2368 | ap = sdata->u.mgd.associated->bssid; |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2369 | |
Arik Nemtsov | d51c2ea | 2015-06-14 16:53:46 +0300 | [diff] [blame] | 2370 | rcu_read_lock(); |
| 2371 | list_for_each_entry_rcu(sta, &sdata->local->sta_list, list) { |
| 2372 | if (!sta->sta.tdls || sta->sdata != sdata || !sta->uploaded || |
| 2373 | !test_sta_flag(sta, WLAN_STA_AUTHORIZED)) |
| 2374 | continue; |
| 2375 | |
| 2376 | tdls_peer_found = true; |
| 2377 | break; |
| 2378 | } |
| 2379 | rcu_read_unlock(); |
| 2380 | |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2381 | if (smps_mode == IEEE80211_SMPS_AUTOMATIC) { |
Arik Nemtsov | d51c2ea | 2015-06-14 16:53:46 +0300 | [diff] [blame] | 2382 | if (tdls_peer_found || !sdata->u.mgd.powersave) |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2383 | smps_mode = IEEE80211_SMPS_OFF; |
Arik Nemtsov | d51c2ea | 2015-06-14 16:53:46 +0300 | [diff] [blame] | 2384 | else |
| 2385 | smps_mode = IEEE80211_SMPS_DYNAMIC; |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2386 | } |
| 2387 | |
| 2388 | /* send SM PS frame to AP */ |
| 2389 | err = ieee80211_send_smps_action(sdata, smps_mode, |
| 2390 | ap, ap); |
| 2391 | if (err) |
| 2392 | sdata->u.mgd.req_smps = old_req; |
Arik Nemtsov | d51c2ea | 2015-06-14 16:53:46 +0300 | [diff] [blame] | 2393 | else if (smps_mode != IEEE80211_SMPS_OFF && tdls_peer_found) |
| 2394 | ieee80211_teardown_tdls_peers(sdata); |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2395 | |
| 2396 | return err; |
| 2397 | } |
| 2398 | |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2399 | static int ieee80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev, |
| 2400 | bool enabled, int timeout) |
| 2401 | { |
| 2402 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 2403 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2404 | |
Bob Copeland | 2d3db21 | 2013-10-29 18:11:59 -0400 | [diff] [blame] | 2405 | if (sdata->vif.type != NL80211_IFTYPE_STATION) |
Benoit Papillault | e5de30c | 2010-01-15 12:21:37 +0100 | [diff] [blame] | 2406 | return -EOPNOTSUPP; |
| 2407 | |
Johannes Berg | 30686bf | 2015-06-02 21:39:54 +0200 | [diff] [blame] | 2408 | if (!ieee80211_hw_check(&local->hw, SUPPORTS_PS)) |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2409 | return -EOPNOTSUPP; |
| 2410 | |
| 2411 | if (enabled == sdata->u.mgd.powersave && |
Juuso Oikarinen | ff61638 | 2010-06-09 09:51:52 +0300 | [diff] [blame] | 2412 | timeout == local->dynamic_ps_forced_timeout) |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2413 | return 0; |
| 2414 | |
| 2415 | sdata->u.mgd.powersave = enabled; |
Juuso Oikarinen | ff61638 | 2010-06-09 09:51:52 +0300 | [diff] [blame] | 2416 | local->dynamic_ps_forced_timeout = timeout; |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2417 | |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2418 | /* no change, but if automatic follow powersave */ |
Johannes Berg | ed405be | 2013-06-03 13:51:59 +0200 | [diff] [blame] | 2419 | sdata_lock(sdata); |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 2420 | __ieee80211_request_smps_mgd(sdata, sdata->u.mgd.req_smps); |
Johannes Berg | ed405be | 2013-06-03 13:51:59 +0200 | [diff] [blame] | 2421 | sdata_unlock(sdata); |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 2422 | |
Johannes Berg | 30686bf | 2015-06-02 21:39:54 +0200 | [diff] [blame] | 2423 | if (ieee80211_hw_check(&local->hw, SUPPORTS_DYNAMIC_PS)) |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2424 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); |
| 2425 | |
Johannes Berg | 4a733ef | 2015-10-14 18:02:43 +0200 | [diff] [blame] | 2426 | ieee80211_recalc_ps(local); |
Eliad Peller | ab09587 | 2012-07-27 12:33:22 +0300 | [diff] [blame] | 2427 | ieee80211_recalc_ps_vif(sdata); |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 2428 | |
| 2429 | return 0; |
| 2430 | } |
| 2431 | |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 2432 | static int ieee80211_set_cqm_rssi_config(struct wiphy *wiphy, |
| 2433 | struct net_device *dev, |
| 2434 | s32 rssi_thold, u32 rssi_hyst) |
| 2435 | { |
| 2436 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 2437 | struct ieee80211_vif *vif = &sdata->vif; |
| 2438 | struct ieee80211_bss_conf *bss_conf = &vif->bss_conf; |
| 2439 | |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 2440 | if (rssi_thold == bss_conf->cqm_rssi_thold && |
| 2441 | rssi_hyst == bss_conf->cqm_rssi_hyst) |
| 2442 | return 0; |
| 2443 | |
Johannes Berg | ef9be10 | 2015-08-28 10:44:20 +0200 | [diff] [blame] | 2444 | if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER && |
| 2445 | !(sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)) |
| 2446 | return -EOPNOTSUPP; |
| 2447 | |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 2448 | bss_conf->cqm_rssi_thold = rssi_thold; |
| 2449 | bss_conf->cqm_rssi_hyst = rssi_hyst; |
Sara Sharon | babc305e2 | 2015-09-21 15:47:40 +0300 | [diff] [blame] | 2450 | sdata->u.mgd.last_cqm_event_signal = 0; |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 2451 | |
| 2452 | /* tell the driver upon association, unless already associated */ |
Johannes Berg | ea08635 | 2012-01-19 09:29:58 +0100 | [diff] [blame] | 2453 | if (sdata->u.mgd.associated && |
| 2454 | sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI) |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 2455 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM); |
| 2456 | |
| 2457 | return 0; |
| 2458 | } |
| 2459 | |
Johannes Berg | 9930380 | 2009-07-01 21:26:59 +0200 | [diff] [blame] | 2460 | static int ieee80211_set_bitrate_mask(struct wiphy *wiphy, |
| 2461 | struct net_device *dev, |
| 2462 | const u8 *addr, |
| 2463 | const struct cfg80211_bitrate_mask *mask) |
| 2464 | { |
| 2465 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 2466 | struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr); |
Sujith Manoharan | bdbfd6b | 2011-04-27 16:56:51 +0530 | [diff] [blame] | 2467 | int i, ret; |
Johannes Berg | 9930380 | 2009-07-01 21:26:59 +0200 | [diff] [blame] | 2468 | |
Eliad Peller | 554a43d | 2012-06-12 12:41:15 +0300 | [diff] [blame] | 2469 | if (!ieee80211_sdata_running(sdata)) |
| 2470 | return -ENETDOWN; |
| 2471 | |
Johannes Berg | 30686bf | 2015-06-02 21:39:54 +0200 | [diff] [blame] | 2472 | if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL)) { |
Sujith Manoharan | bdbfd6b | 2011-04-27 16:56:51 +0530 | [diff] [blame] | 2473 | ret = drv_set_bitrate_mask(local, sdata, mask); |
| 2474 | if (ret) |
| 2475 | return ret; |
| 2476 | } |
Johannes Berg | 9930380 | 2009-07-01 21:26:59 +0200 | [diff] [blame] | 2477 | |
Simon Wunderlich | 1946841 | 2012-01-28 17:25:33 +0100 | [diff] [blame] | 2478 | for (i = 0; i < IEEE80211_NUM_BANDS; i++) { |
Felix Fietkau | 2ffbe6d | 2013-04-16 13:38:42 +0200 | [diff] [blame] | 2479 | struct ieee80211_supported_band *sband = wiphy->bands[i]; |
| 2480 | int j; |
| 2481 | |
Jouni Malinen | 37eb0b1 | 2010-01-06 13:09:08 +0200 | [diff] [blame] | 2482 | sdata->rc_rateidx_mask[i] = mask->control[i].legacy; |
Janusz Dziedzic | d1e33e6 | 2013-12-05 10:02:15 +0100 | [diff] [blame] | 2483 | memcpy(sdata->rc_rateidx_mcs_mask[i], mask->control[i].ht_mcs, |
| 2484 | sizeof(mask->control[i].ht_mcs)); |
Lorenzo Bianconi | b119ad6 | 2015-08-06 23:47:33 +0200 | [diff] [blame] | 2485 | memcpy(sdata->rc_rateidx_vht_mcs_mask[i], |
| 2486 | mask->control[i].vht_mcs, |
| 2487 | sizeof(mask->control[i].vht_mcs)); |
Felix Fietkau | 2ffbe6d | 2013-04-16 13:38:42 +0200 | [diff] [blame] | 2488 | |
| 2489 | sdata->rc_has_mcs_mask[i] = false; |
Lorenzo Bianconi | b119ad6 | 2015-08-06 23:47:33 +0200 | [diff] [blame] | 2490 | sdata->rc_has_vht_mcs_mask[i] = false; |
Felix Fietkau | 2ffbe6d | 2013-04-16 13:38:42 +0200 | [diff] [blame] | 2491 | if (!sband) |
| 2492 | continue; |
| 2493 | |
Lorenzo Bianconi | b119ad6 | 2015-08-06 23:47:33 +0200 | [diff] [blame] | 2494 | for (j = 0; j < IEEE80211_HT_MCS_MASK_LEN; j++) { |
Johannes Berg | 2df1b13 | 2015-08-21 14:07:13 +0200 | [diff] [blame] | 2495 | if (~sdata->rc_rateidx_mcs_mask[i][j]) { |
Felix Fietkau | 2ffbe6d | 2013-04-16 13:38:42 +0200 | [diff] [blame] | 2496 | sdata->rc_has_mcs_mask[i] = true; |
| 2497 | break; |
Johannes Berg | 2df1b13 | 2015-08-21 14:07:13 +0200 | [diff] [blame] | 2498 | } |
| 2499 | } |
| 2500 | |
| 2501 | for (j = 0; j < NL80211_VHT_NSS_MAX; j++) { |
| 2502 | if (~sdata->rc_rateidx_vht_mcs_mask[i][j]) { |
| 2503 | sdata->rc_has_vht_mcs_mask[i] = true; |
| 2504 | break; |
| 2505 | } |
Lorenzo Bianconi | b119ad6 | 2015-08-06 23:47:33 +0200 | [diff] [blame] | 2506 | } |
Simon Wunderlich | 1946841 | 2012-01-28 17:25:33 +0100 | [diff] [blame] | 2507 | } |
Johannes Berg | 9930380 | 2009-07-01 21:26:59 +0200 | [diff] [blame] | 2508 | |
Jouni Malinen | 37eb0b1 | 2010-01-06 13:09:08 +0200 | [diff] [blame] | 2509 | return 0; |
Johannes Berg | 9930380 | 2009-07-01 21:26:59 +0200 | [diff] [blame] | 2510 | } |
| 2511 | |
Eliad Peller | eaa336b | 2014-09-03 15:25:06 +0300 | [diff] [blame] | 2512 | static bool ieee80211_coalesce_started_roc(struct ieee80211_local *local, |
| 2513 | struct ieee80211_roc_work *new_roc, |
| 2514 | struct ieee80211_roc_work *cur_roc) |
| 2515 | { |
Johannes Berg | 252ec2b | 2015-05-19 13:36:38 +0200 | [diff] [blame] | 2516 | unsigned long now = jiffies; |
| 2517 | unsigned long remaining = cur_roc->hw_start_time + |
| 2518 | msecs_to_jiffies(cur_roc->duration) - |
| 2519 | now; |
Eliad Peller | eaa336b | 2014-09-03 15:25:06 +0300 | [diff] [blame] | 2520 | |
| 2521 | if (WARN_ON(!cur_roc->started || !cur_roc->hw_begun)) |
| 2522 | return false; |
| 2523 | |
Johannes Berg | 252ec2b | 2015-05-19 13:36:38 +0200 | [diff] [blame] | 2524 | /* if it doesn't fit entirely, schedule a new one */ |
| 2525 | if (new_roc->duration > jiffies_to_msecs(remaining)) |
Eliad Peller | eaa336b | 2014-09-03 15:25:06 +0300 | [diff] [blame] | 2526 | return false; |
| 2527 | |
| 2528 | ieee80211_handle_roc_started(new_roc); |
| 2529 | |
Johannes Berg | 252ec2b | 2015-05-19 13:36:38 +0200 | [diff] [blame] | 2530 | /* add to dependents so we send the expired event properly */ |
| 2531 | list_add_tail(&new_roc->list, &cur_roc->dependents); |
Eliad Peller | eaa336b | 2014-09-03 15:25:06 +0300 | [diff] [blame] | 2532 | return true; |
| 2533 | } |
| 2534 | |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 2535 | static u64 ieee80211_mgmt_tx_cookie(struct ieee80211_local *local) |
| 2536 | { |
| 2537 | lockdep_assert_held(&local->mtx); |
| 2538 | |
| 2539 | local->roc_cookie_counter++; |
| 2540 | |
| 2541 | /* wow, you wrapped 64 bits ... more likely a bug */ |
| 2542 | if (WARN_ON(local->roc_cookie_counter == 0)) |
| 2543 | local->roc_cookie_counter++; |
| 2544 | |
| 2545 | return local->roc_cookie_counter; |
| 2546 | } |
| 2547 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2548 | static int ieee80211_start_roc_work(struct ieee80211_local *local, |
| 2549 | struct ieee80211_sub_if_data *sdata, |
| 2550 | struct ieee80211_channel *channel, |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2551 | unsigned int duration, u64 *cookie, |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2552 | struct sk_buff *txskb, |
| 2553 | enum ieee80211_roc_type type) |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2554 | { |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2555 | struct ieee80211_roc_work *roc, *tmp; |
| 2556 | bool queued = false; |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2557 | int ret; |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2558 | |
| 2559 | lockdep_assert_held(&local->mtx); |
| 2560 | |
Johannes Berg | fe57d9f | 2012-07-26 14:55:08 +0200 | [diff] [blame] | 2561 | if (local->use_chanctx && !local->ops->remain_on_channel) |
| 2562 | return -EOPNOTSUPP; |
| 2563 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2564 | roc = kzalloc(sizeof(*roc), GFP_KERNEL); |
| 2565 | if (!roc) |
| 2566 | return -ENOMEM; |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2567 | |
Ilan Peer | 2fae062 | 2013-12-19 13:25:29 +0200 | [diff] [blame] | 2568 | /* |
| 2569 | * If the duration is zero, then the driver |
| 2570 | * wouldn't actually do anything. Set it to |
| 2571 | * 10 for now. |
| 2572 | * |
| 2573 | * TODO: cancel the off-channel operation |
| 2574 | * when we get the SKB's TX status and |
| 2575 | * the wait time was zero before. |
| 2576 | */ |
| 2577 | if (!duration) |
| 2578 | duration = 10; |
| 2579 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2580 | roc->chan = channel; |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2581 | roc->duration = duration; |
| 2582 | roc->req_duration = duration; |
| 2583 | roc->frame = txskb; |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2584 | roc->type = type; |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2585 | roc->sdata = sdata; |
| 2586 | INIT_DELAYED_WORK(&roc->work, ieee80211_sw_roc_work); |
| 2587 | INIT_LIST_HEAD(&roc->dependents); |
| 2588 | |
Eliad Peller | 2f61743 | 2014-01-12 11:06:37 +0200 | [diff] [blame] | 2589 | /* |
| 2590 | * cookie is either the roc cookie (for normal roc) |
| 2591 | * or the SKB (for mgmt TX) |
| 2592 | */ |
| 2593 | if (!txskb) { |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 2594 | roc->cookie = ieee80211_mgmt_tx_cookie(local); |
Eliad Peller | 2f61743 | 2014-01-12 11:06:37 +0200 | [diff] [blame] | 2595 | *cookie = roc->cookie; |
| 2596 | } else { |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 2597 | roc->mgmt_tx_cookie = *cookie; |
Eliad Peller | 2f61743 | 2014-01-12 11:06:37 +0200 | [diff] [blame] | 2598 | } |
| 2599 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2600 | /* if there's one pending or we're scanning, queue this one */ |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2601 | if (!list_empty(&local->roc_list) || |
Eliad Peller | 5cbc95a | 2015-01-07 17:50:09 +0200 | [diff] [blame] | 2602 | local->scanning || ieee80211_is_radar_required(local)) |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2603 | goto out_check_combine; |
| 2604 | |
| 2605 | /* if not HW assist, just queue & schedule work */ |
| 2606 | if (!local->ops->remain_on_channel) { |
| 2607 | ieee80211_queue_delayed_work(&local->hw, &roc->work, 0); |
| 2608 | goto out_queue; |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2609 | } |
| 2610 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2611 | /* otherwise actually kick it off here (for error handling) */ |
| 2612 | |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2613 | ret = drv_remain_on_channel(local, sdata, channel, duration, type); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2614 | if (ret) { |
| 2615 | kfree(roc); |
| 2616 | return ret; |
| 2617 | } |
| 2618 | |
| 2619 | roc->started = true; |
| 2620 | goto out_queue; |
| 2621 | |
| 2622 | out_check_combine: |
| 2623 | list_for_each_entry(tmp, &local->roc_list, list) { |
Johannes Berg | 42d97a5 | 2012-11-08 18:31:02 +0100 | [diff] [blame] | 2624 | if (tmp->chan != channel || tmp->sdata != sdata) |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2625 | continue; |
| 2626 | |
| 2627 | /* |
| 2628 | * Extend this ROC if possible: |
| 2629 | * |
| 2630 | * If it hasn't started yet, just increase the duration |
| 2631 | * and add the new one to the list of dependents. |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2632 | * If the type of the new ROC has higher priority, modify the |
| 2633 | * type of the previous one to match that of the new one. |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2634 | */ |
| 2635 | if (!tmp->started) { |
| 2636 | list_add_tail(&roc->list, &tmp->dependents); |
| 2637 | tmp->duration = max(tmp->duration, roc->duration); |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2638 | tmp->type = max(tmp->type, roc->type); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2639 | queued = true; |
| 2640 | break; |
| 2641 | } |
| 2642 | |
| 2643 | /* If it has already started, it's more difficult ... */ |
| 2644 | if (local->ops->remain_on_channel) { |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2645 | /* |
| 2646 | * In the offloaded ROC case, if it hasn't begun, add |
| 2647 | * this new one to the dependent list to be handled |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2648 | * when the master one begins. If it has begun, |
Johannes Berg | 252ec2b | 2015-05-19 13:36:38 +0200 | [diff] [blame] | 2649 | * check if it fits entirely within the existing one, |
| 2650 | * in which case it will just be dependent as well. |
| 2651 | * Otherwise, schedule it by itself. |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2652 | */ |
| 2653 | if (!tmp->hw_begun) { |
| 2654 | list_add_tail(&roc->list, &tmp->dependents); |
| 2655 | queued = true; |
| 2656 | break; |
| 2657 | } |
| 2658 | |
Eliad Peller | eaa336b | 2014-09-03 15:25:06 +0300 | [diff] [blame] | 2659 | if (ieee80211_coalesce_started_roc(local, roc, tmp)) |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2660 | queued = true; |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2661 | } else if (del_timer_sync(&tmp->work.timer)) { |
| 2662 | unsigned long new_end; |
| 2663 | |
| 2664 | /* |
| 2665 | * In the software ROC case, cancel the timer, if |
| 2666 | * that fails then the finish work is already |
| 2667 | * queued/pending and thus we queue the new ROC |
| 2668 | * normally, if that succeeds then we can extend |
| 2669 | * the timer duration and TX the frame (if any.) |
| 2670 | */ |
| 2671 | |
| 2672 | list_add_tail(&roc->list, &tmp->dependents); |
| 2673 | queued = true; |
| 2674 | |
| 2675 | new_end = jiffies + msecs_to_jiffies(roc->duration); |
| 2676 | |
| 2677 | /* ok, it was started & we canceled timer */ |
| 2678 | if (time_after(new_end, tmp->work.timer.expires)) |
| 2679 | mod_timer(&tmp->work.timer, new_end); |
| 2680 | else |
| 2681 | add_timer(&tmp->work.timer); |
| 2682 | |
| 2683 | ieee80211_handle_roc_started(roc); |
| 2684 | } |
| 2685 | break; |
| 2686 | } |
| 2687 | |
| 2688 | out_queue: |
| 2689 | if (!queued) |
| 2690 | list_add_tail(&roc->list, &local->roc_list); |
| 2691 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2692 | return 0; |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2693 | } |
| 2694 | |
Johannes Berg | b8bc4b0 | 2009-12-23 13:15:42 +0100 | [diff] [blame] | 2695 | static int ieee80211_remain_on_channel(struct wiphy *wiphy, |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 2696 | struct wireless_dev *wdev, |
Johannes Berg | b8bc4b0 | 2009-12-23 13:15:42 +0100 | [diff] [blame] | 2697 | struct ieee80211_channel *chan, |
Johannes Berg | b8bc4b0 | 2009-12-23 13:15:42 +0100 | [diff] [blame] | 2698 | unsigned int duration, |
| 2699 | u64 *cookie) |
| 2700 | { |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 2701 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2702 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2703 | int ret; |
| 2704 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2705 | mutex_lock(&local->mtx); |
Johannes Berg | 42d97a5 | 2012-11-08 18:31:02 +0100 | [diff] [blame] | 2706 | ret = ieee80211_start_roc_work(local, sdata, chan, |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 2707 | duration, cookie, NULL, |
| 2708 | IEEE80211_ROC_TYPE_NORMAL); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2709 | mutex_unlock(&local->mtx); |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2710 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2711 | return ret; |
| 2712 | } |
| 2713 | |
| 2714 | static int ieee80211_cancel_roc(struct ieee80211_local *local, |
| 2715 | u64 cookie, bool mgmt_tx) |
| 2716 | { |
| 2717 | struct ieee80211_roc_work *roc, *tmp, *found = NULL; |
| 2718 | int ret; |
| 2719 | |
| 2720 | mutex_lock(&local->mtx); |
| 2721 | list_for_each_entry_safe(roc, tmp, &local->roc_list, list) { |
Johannes Berg | e979e33 | 2012-06-11 17:09:41 +0200 | [diff] [blame] | 2722 | struct ieee80211_roc_work *dep, *tmp2; |
| 2723 | |
| 2724 | list_for_each_entry_safe(dep, tmp2, &roc->dependents, list) { |
Johannes Berg | 50febf6 | 2012-10-26 16:13:06 +0200 | [diff] [blame] | 2725 | if (!mgmt_tx && dep->cookie != cookie) |
Johannes Berg | e979e33 | 2012-06-11 17:09:41 +0200 | [diff] [blame] | 2726 | continue; |
| 2727 | else if (mgmt_tx && dep->mgmt_tx_cookie != cookie) |
| 2728 | continue; |
| 2729 | /* found dependent item -- just remove it */ |
| 2730 | list_del(&dep->list); |
| 2731 | mutex_unlock(&local->mtx); |
| 2732 | |
Johannes Berg | 3fbd45c | 2013-03-25 11:51:14 +0100 | [diff] [blame] | 2733 | ieee80211_roc_notify_destroy(dep, true); |
Johannes Berg | e979e33 | 2012-06-11 17:09:41 +0200 | [diff] [blame] | 2734 | return 0; |
| 2735 | } |
| 2736 | |
Johannes Berg | 50febf6 | 2012-10-26 16:13:06 +0200 | [diff] [blame] | 2737 | if (!mgmt_tx && roc->cookie != cookie) |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2738 | continue; |
| 2739 | else if (mgmt_tx && roc->mgmt_tx_cookie != cookie) |
| 2740 | continue; |
| 2741 | |
| 2742 | found = roc; |
| 2743 | break; |
| 2744 | } |
| 2745 | |
| 2746 | if (!found) { |
| 2747 | mutex_unlock(&local->mtx); |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2748 | return -ENOENT; |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2749 | } |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2750 | |
Johannes Berg | e979e33 | 2012-06-11 17:09:41 +0200 | [diff] [blame] | 2751 | /* |
| 2752 | * We found the item to cancel, so do that. Note that it |
| 2753 | * may have dependents, which we also cancel (and send |
| 2754 | * the expired signal for.) Not doing so would be quite |
| 2755 | * tricky here, but we may need to fix it later. |
| 2756 | */ |
| 2757 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2758 | if (local->ops->remain_on_channel) { |
| 2759 | if (found->started) { |
| 2760 | ret = drv_cancel_remain_on_channel(local); |
| 2761 | if (WARN_ON_ONCE(ret)) { |
| 2762 | mutex_unlock(&local->mtx); |
| 2763 | return ret; |
| 2764 | } |
| 2765 | } |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2766 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2767 | list_del(&found->list); |
| 2768 | |
Johannes Berg | 0f6b3f5 | 2012-06-20 20:11:33 +0200 | [diff] [blame] | 2769 | if (found->started) |
| 2770 | ieee80211_start_next_roc(local); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2771 | mutex_unlock(&local->mtx); |
| 2772 | |
Johannes Berg | 3fbd45c | 2013-03-25 11:51:14 +0100 | [diff] [blame] | 2773 | ieee80211_roc_notify_destroy(found, true); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2774 | } else { |
| 2775 | /* work may be pending so use it all the time */ |
| 2776 | found->abort = true; |
| 2777 | ieee80211_queue_delayed_work(&local->hw, &found->work, 0); |
| 2778 | |
| 2779 | mutex_unlock(&local->mtx); |
| 2780 | |
| 2781 | /* work will clean up etc */ |
| 2782 | flush_delayed_work(&found->work); |
Johannes Berg | 3fbd45c | 2013-03-25 11:51:14 +0100 | [diff] [blame] | 2783 | WARN_ON(!found->to_be_freed); |
| 2784 | kfree(found); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2785 | } |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2786 | |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2787 | return 0; |
| 2788 | } |
| 2789 | |
Johannes Berg | b8bc4b0 | 2009-12-23 13:15:42 +0100 | [diff] [blame] | 2790 | static int ieee80211_cancel_remain_on_channel(struct wiphy *wiphy, |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 2791 | struct wireless_dev *wdev, |
Johannes Berg | b8bc4b0 | 2009-12-23 13:15:42 +0100 | [diff] [blame] | 2792 | u64 cookie) |
| 2793 | { |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 2794 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Johannes Berg | 21f8358 | 2010-12-18 17:20:47 +0100 | [diff] [blame] | 2795 | struct ieee80211_local *local = sdata->local; |
| 2796 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 2797 | return ieee80211_cancel_roc(local, cookie, false); |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 2798 | } |
| 2799 | |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2800 | static int ieee80211_start_radar_detection(struct wiphy *wiphy, |
| 2801 | struct net_device *dev, |
Janusz Dziedzic | 31559f3 | 2014-02-21 19:46:13 +0100 | [diff] [blame] | 2802 | struct cfg80211_chan_def *chandef, |
| 2803 | u32 cac_time_ms) |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2804 | { |
| 2805 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 2806 | struct ieee80211_local *local = sdata->local; |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2807 | int err; |
| 2808 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2809 | mutex_lock(&local->mtx); |
| 2810 | if (!list_empty(&local->roc_list) || local->scanning) { |
| 2811 | err = -EBUSY; |
| 2812 | goto out_unlock; |
| 2813 | } |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2814 | |
| 2815 | /* whatever, but channel contexts should not complain about that one */ |
| 2816 | sdata->smps_mode = IEEE80211_SMPS_OFF; |
| 2817 | sdata->needed_rx_chains = local->rx_chains; |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2818 | |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2819 | err = ieee80211_vif_use_channel(sdata, chandef, |
| 2820 | IEEE80211_CHANCTX_SHARED); |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2821 | if (err) |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2822 | goto out_unlock; |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2823 | |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2824 | ieee80211_queue_delayed_work(&sdata->local->hw, |
Janusz Dziedzic | 31559f3 | 2014-02-21 19:46:13 +0100 | [diff] [blame] | 2825 | &sdata->dfs_cac_timer_work, |
| 2826 | msecs_to_jiffies(cac_time_ms)); |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2827 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2828 | out_unlock: |
| 2829 | mutex_unlock(&local->mtx); |
| 2830 | return err; |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 2831 | } |
| 2832 | |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 2833 | static struct cfg80211_beacon_data * |
| 2834 | cfg80211_beacon_dup(struct cfg80211_beacon_data *beacon) |
| 2835 | { |
| 2836 | struct cfg80211_beacon_data *new_beacon; |
| 2837 | u8 *pos; |
| 2838 | int len; |
| 2839 | |
| 2840 | len = beacon->head_len + beacon->tail_len + beacon->beacon_ies_len + |
| 2841 | beacon->proberesp_ies_len + beacon->assocresp_ies_len + |
| 2842 | beacon->probe_resp_len; |
| 2843 | |
| 2844 | new_beacon = kzalloc(sizeof(*new_beacon) + len, GFP_KERNEL); |
| 2845 | if (!new_beacon) |
| 2846 | return NULL; |
| 2847 | |
| 2848 | pos = (u8 *)(new_beacon + 1); |
| 2849 | if (beacon->head_len) { |
| 2850 | new_beacon->head_len = beacon->head_len; |
| 2851 | new_beacon->head = pos; |
| 2852 | memcpy(pos, beacon->head, beacon->head_len); |
| 2853 | pos += beacon->head_len; |
| 2854 | } |
| 2855 | if (beacon->tail_len) { |
| 2856 | new_beacon->tail_len = beacon->tail_len; |
| 2857 | new_beacon->tail = pos; |
| 2858 | memcpy(pos, beacon->tail, beacon->tail_len); |
| 2859 | pos += beacon->tail_len; |
| 2860 | } |
| 2861 | if (beacon->beacon_ies_len) { |
| 2862 | new_beacon->beacon_ies_len = beacon->beacon_ies_len; |
| 2863 | new_beacon->beacon_ies = pos; |
| 2864 | memcpy(pos, beacon->beacon_ies, beacon->beacon_ies_len); |
| 2865 | pos += beacon->beacon_ies_len; |
| 2866 | } |
| 2867 | if (beacon->proberesp_ies_len) { |
| 2868 | new_beacon->proberesp_ies_len = beacon->proberesp_ies_len; |
| 2869 | new_beacon->proberesp_ies = pos; |
| 2870 | memcpy(pos, beacon->proberesp_ies, beacon->proberesp_ies_len); |
| 2871 | pos += beacon->proberesp_ies_len; |
| 2872 | } |
| 2873 | if (beacon->assocresp_ies_len) { |
| 2874 | new_beacon->assocresp_ies_len = beacon->assocresp_ies_len; |
| 2875 | new_beacon->assocresp_ies = pos; |
| 2876 | memcpy(pos, beacon->assocresp_ies, beacon->assocresp_ies_len); |
| 2877 | pos += beacon->assocresp_ies_len; |
| 2878 | } |
| 2879 | if (beacon->probe_resp_len) { |
| 2880 | new_beacon->probe_resp_len = beacon->probe_resp_len; |
| 2881 | beacon->probe_resp = pos; |
| 2882 | memcpy(pos, beacon->probe_resp, beacon->probe_resp_len); |
| 2883 | pos += beacon->probe_resp_len; |
| 2884 | } |
| 2885 | |
| 2886 | return new_beacon; |
| 2887 | } |
| 2888 | |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 2889 | void ieee80211_csa_finish(struct ieee80211_vif *vif) |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 2890 | { |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 2891 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
| 2892 | |
| 2893 | ieee80211_queue_work(&sdata->local->hw, |
| 2894 | &sdata->csa_finalize_work); |
| 2895 | } |
| 2896 | EXPORT_SYMBOL(ieee80211_csa_finish); |
| 2897 | |
Michal Kazior | 6619950 | 2014-04-09 15:11:00 +0200 | [diff] [blame] | 2898 | static int ieee80211_set_after_csa_beacon(struct ieee80211_sub_if_data *sdata, |
| 2899 | u32 *changed) |
| 2900 | { |
| 2901 | int err; |
| 2902 | |
| 2903 | switch (sdata->vif.type) { |
| 2904 | case NL80211_IFTYPE_AP: |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 2905 | err = ieee80211_assign_beacon(sdata, sdata->u.ap.next_beacon, |
| 2906 | NULL); |
Michal Kazior | 6619950 | 2014-04-09 15:11:00 +0200 | [diff] [blame] | 2907 | kfree(sdata->u.ap.next_beacon); |
| 2908 | sdata->u.ap.next_beacon = NULL; |
| 2909 | |
| 2910 | if (err < 0) |
| 2911 | return err; |
| 2912 | *changed |= err; |
| 2913 | break; |
| 2914 | case NL80211_IFTYPE_ADHOC: |
| 2915 | err = ieee80211_ibss_finish_csa(sdata); |
| 2916 | if (err < 0) |
| 2917 | return err; |
| 2918 | *changed |= err; |
| 2919 | break; |
| 2920 | #ifdef CONFIG_MAC80211_MESH |
| 2921 | case NL80211_IFTYPE_MESH_POINT: |
| 2922 | err = ieee80211_mesh_finish_csa(sdata); |
| 2923 | if (err < 0) |
| 2924 | return err; |
| 2925 | *changed |= err; |
| 2926 | break; |
| 2927 | #endif |
| 2928 | default: |
| 2929 | WARN_ON(1); |
| 2930 | return -EINVAL; |
| 2931 | } |
| 2932 | |
| 2933 | return 0; |
| 2934 | } |
| 2935 | |
Michal Kazior | cf8767d | 2014-05-08 09:10:02 +0200 | [diff] [blame] | 2936 | static int __ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata) |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 2937 | { |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 2938 | struct ieee80211_local *local = sdata->local; |
Michal Kazior | 6619950 | 2014-04-09 15:11:00 +0200 | [diff] [blame] | 2939 | u32 changed = 0; |
| 2940 | int err; |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 2941 | |
Michal Kazior | dbd7285 | 2014-01-29 07:56:21 +0100 | [diff] [blame] | 2942 | sdata_assert_lock(sdata); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 2943 | lockdep_assert_held(&local->mtx); |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 2944 | lockdep_assert_held(&local->chanctx_mtx); |
Michal Kazior | dbd7285 | 2014-01-29 07:56:21 +0100 | [diff] [blame] | 2945 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 2946 | /* |
| 2947 | * using reservation isn't immediate as it may be deferred until later |
| 2948 | * with multi-vif. once reservation is complete it will re-schedule the |
| 2949 | * work with no reserved_chanctx so verify chandef to check if it |
| 2950 | * completed successfully |
| 2951 | */ |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 2952 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 2953 | if (sdata->reserved_chanctx) { |
| 2954 | /* |
| 2955 | * with multi-vif csa driver may call ieee80211_csa_finish() |
| 2956 | * many times while waiting for other interfaces to use their |
| 2957 | * reservations |
| 2958 | */ |
| 2959 | if (sdata->reserved_ready) |
| 2960 | return 0; |
| 2961 | |
Fabian Frederick | 408b18a | 2014-10-09 20:36:22 +0200 | [diff] [blame] | 2962 | return ieee80211_vif_use_reserved_context(sdata); |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 2963 | } |
| 2964 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 2965 | if (!cfg80211_chandef_identical(&sdata->vif.bss_conf.chandef, |
| 2966 | &sdata->csa_chandef)) |
| 2967 | return -EINVAL; |
| 2968 | |
Simon Wunderlich | e487eae | 2013-11-21 18:19:51 +0100 | [diff] [blame] | 2969 | sdata->vif.csa_active = false; |
Michal Kazior | 97518af | 2014-01-29 07:56:18 +0100 | [diff] [blame] | 2970 | |
Michal Kazior | 6619950 | 2014-04-09 15:11:00 +0200 | [diff] [blame] | 2971 | err = ieee80211_set_after_csa_beacon(sdata, &changed); |
| 2972 | if (err) |
Michal Kazior | cf8767d | 2014-05-08 09:10:02 +0200 | [diff] [blame] | 2973 | return err; |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 2974 | |
Michal Kazior | faf046e | 2014-01-29 07:56:17 +0100 | [diff] [blame] | 2975 | ieee80211_bss_info_change_notify(sdata, changed); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 2976 | |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 2977 | if (sdata->csa_block_tx) { |
| 2978 | ieee80211_wake_vif_queues(local, sdata, |
| 2979 | IEEE80211_QUEUE_STOP_REASON_CSA); |
| 2980 | sdata->csa_block_tx = false; |
| 2981 | } |
Michal Kazior | cf8767d | 2014-05-08 09:10:02 +0200 | [diff] [blame] | 2982 | |
Luciano Coelho | f1d6558 | 2014-10-08 09:48:38 +0300 | [diff] [blame] | 2983 | err = drv_post_channel_switch(sdata); |
| 2984 | if (err) |
| 2985 | return err; |
| 2986 | |
| 2987 | cfg80211_ch_switch_notify(sdata->dev, &sdata->csa_chandef); |
| 2988 | |
Michal Kazior | cf8767d | 2014-05-08 09:10:02 +0200 | [diff] [blame] | 2989 | return 0; |
| 2990 | } |
| 2991 | |
| 2992 | static void ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata) |
| 2993 | { |
| 2994 | if (__ieee80211_csa_finalize(sdata)) { |
| 2995 | sdata_info(sdata, "failed to finalize CSA, disconnecting\n"); |
| 2996 | cfg80211_stop_iface(sdata->local->hw.wiphy, &sdata->wdev, |
| 2997 | GFP_KERNEL); |
| 2998 | } |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 2999 | } |
| 3000 | |
| 3001 | void ieee80211_csa_finalize_work(struct work_struct *work) |
| 3002 | { |
| 3003 | struct ieee80211_sub_if_data *sdata = |
| 3004 | container_of(work, struct ieee80211_sub_if_data, |
| 3005 | csa_finalize_work); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3006 | struct ieee80211_local *local = sdata->local; |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 3007 | |
| 3008 | sdata_lock(sdata); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3009 | mutex_lock(&local->mtx); |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 3010 | mutex_lock(&local->chanctx_mtx); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3011 | |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 3012 | /* AP might have been stopped while waiting for the lock. */ |
| 3013 | if (!sdata->vif.csa_active) |
| 3014 | goto unlock; |
| 3015 | |
| 3016 | if (!ieee80211_sdata_running(sdata)) |
| 3017 | goto unlock; |
| 3018 | |
| 3019 | ieee80211_csa_finalize(sdata); |
Simon Wunderlich | e487eae | 2013-11-21 18:19:51 +0100 | [diff] [blame] | 3020 | |
| 3021 | unlock: |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 3022 | mutex_unlock(&local->chanctx_mtx); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3023 | mutex_unlock(&local->mtx); |
Simon Wunderlich | e487eae | 2013-11-21 18:19:51 +0100 | [diff] [blame] | 3024 | sdata_unlock(sdata); |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3025 | } |
| 3026 | |
Michal Kazior | 37fa2bd | 2014-02-28 15:59:06 +0100 | [diff] [blame] | 3027 | static int ieee80211_set_csa_beacon(struct ieee80211_sub_if_data *sdata, |
| 3028 | struct cfg80211_csa_settings *params, |
| 3029 | u32 *changed) |
| 3030 | { |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 3031 | struct ieee80211_csa_settings csa = {}; |
Michal Kazior | 37fa2bd | 2014-02-28 15:59:06 +0100 | [diff] [blame] | 3032 | int err; |
| 3033 | |
| 3034 | switch (sdata->vif.type) { |
| 3035 | case NL80211_IFTYPE_AP: |
| 3036 | sdata->u.ap.next_beacon = |
| 3037 | cfg80211_beacon_dup(¶ms->beacon_after); |
| 3038 | if (!sdata->u.ap.next_beacon) |
| 3039 | return -ENOMEM; |
| 3040 | |
| 3041 | /* |
| 3042 | * With a count of 0, we don't have to wait for any |
| 3043 | * TBTT before switching, so complete the CSA |
| 3044 | * immediately. In theory, with a count == 1 we |
| 3045 | * should delay the switch until just before the next |
| 3046 | * TBTT, but that would complicate things so we switch |
| 3047 | * immediately too. If we would delay the switch |
| 3048 | * until the next TBTT, we would have to set the probe |
| 3049 | * response here. |
| 3050 | * |
| 3051 | * TODO: A channel switch with count <= 1 without |
| 3052 | * sending a CSA action frame is kind of useless, |
| 3053 | * because the clients won't know we're changing |
| 3054 | * channels. The action frame must be implemented |
| 3055 | * either here or in the userspace. |
| 3056 | */ |
| 3057 | if (params->count <= 1) |
| 3058 | break; |
| 3059 | |
Andrei Otcheretianski | 0d06d9b | 2014-05-09 14:11:47 +0300 | [diff] [blame] | 3060 | if ((params->n_counter_offsets_beacon > |
| 3061 | IEEE80211_MAX_CSA_COUNTERS_NUM) || |
| 3062 | (params->n_counter_offsets_presp > |
| 3063 | IEEE80211_MAX_CSA_COUNTERS_NUM)) |
| 3064 | return -EINVAL; |
Andrei Otcheretianski | 9a774c7 | 2014-05-09 14:11:46 +0300 | [diff] [blame] | 3065 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 3066 | csa.counter_offsets_beacon = params->counter_offsets_beacon; |
| 3067 | csa.counter_offsets_presp = params->counter_offsets_presp; |
| 3068 | csa.n_counter_offsets_beacon = params->n_counter_offsets_beacon; |
| 3069 | csa.n_counter_offsets_presp = params->n_counter_offsets_presp; |
| 3070 | csa.count = params->count; |
Andrei Otcheretianski | 0d06d9b | 2014-05-09 14:11:47 +0300 | [diff] [blame] | 3071 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 3072 | err = ieee80211_assign_beacon(sdata, ¶ms->beacon_csa, &csa); |
Michal Kazior | 37fa2bd | 2014-02-28 15:59:06 +0100 | [diff] [blame] | 3073 | if (err < 0) { |
| 3074 | kfree(sdata->u.ap.next_beacon); |
| 3075 | return err; |
| 3076 | } |
| 3077 | *changed |= err; |
| 3078 | |
| 3079 | break; |
| 3080 | case NL80211_IFTYPE_ADHOC: |
| 3081 | if (!sdata->vif.bss_conf.ibss_joined) |
| 3082 | return -EINVAL; |
| 3083 | |
| 3084 | if (params->chandef.width != sdata->u.ibss.chandef.width) |
| 3085 | return -EINVAL; |
| 3086 | |
| 3087 | switch (params->chandef.width) { |
| 3088 | case NL80211_CHAN_WIDTH_40: |
| 3089 | if (cfg80211_get_chandef_type(¶ms->chandef) != |
| 3090 | cfg80211_get_chandef_type(&sdata->u.ibss.chandef)) |
| 3091 | return -EINVAL; |
| 3092 | case NL80211_CHAN_WIDTH_5: |
| 3093 | case NL80211_CHAN_WIDTH_10: |
| 3094 | case NL80211_CHAN_WIDTH_20_NOHT: |
| 3095 | case NL80211_CHAN_WIDTH_20: |
| 3096 | break; |
| 3097 | default: |
| 3098 | return -EINVAL; |
| 3099 | } |
| 3100 | |
| 3101 | /* changes into another band are not supported */ |
| 3102 | if (sdata->u.ibss.chandef.chan->band != |
| 3103 | params->chandef.chan->band) |
| 3104 | return -EINVAL; |
| 3105 | |
| 3106 | /* see comments in the NL80211_IFTYPE_AP block */ |
| 3107 | if (params->count > 1) { |
| 3108 | err = ieee80211_ibss_csa_beacon(sdata, params); |
| 3109 | if (err < 0) |
| 3110 | return err; |
| 3111 | *changed |= err; |
| 3112 | } |
| 3113 | |
| 3114 | ieee80211_send_action_csa(sdata, params); |
| 3115 | |
| 3116 | break; |
| 3117 | #ifdef CONFIG_MAC80211_MESH |
| 3118 | case NL80211_IFTYPE_MESH_POINT: { |
| 3119 | struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh; |
| 3120 | |
| 3121 | if (params->chandef.width != sdata->vif.bss_conf.chandef.width) |
| 3122 | return -EINVAL; |
| 3123 | |
| 3124 | /* changes into another band are not supported */ |
| 3125 | if (sdata->vif.bss_conf.chandef.chan->band != |
| 3126 | params->chandef.chan->band) |
| 3127 | return -EINVAL; |
| 3128 | |
| 3129 | if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_NONE) { |
| 3130 | ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_INIT; |
| 3131 | if (!ifmsh->pre_value) |
| 3132 | ifmsh->pre_value = 1; |
| 3133 | else |
| 3134 | ifmsh->pre_value++; |
| 3135 | } |
| 3136 | |
| 3137 | /* see comments in the NL80211_IFTYPE_AP block */ |
| 3138 | if (params->count > 1) { |
| 3139 | err = ieee80211_mesh_csa_beacon(sdata, params); |
| 3140 | if (err < 0) { |
| 3141 | ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_NONE; |
| 3142 | return err; |
| 3143 | } |
| 3144 | *changed |= err; |
| 3145 | } |
| 3146 | |
| 3147 | if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_INIT) |
| 3148 | ieee80211_send_action_csa(sdata, params); |
| 3149 | |
| 3150 | break; |
| 3151 | } |
| 3152 | #endif |
| 3153 | default: |
| 3154 | return -EOPNOTSUPP; |
| 3155 | } |
| 3156 | |
| 3157 | return 0; |
| 3158 | } |
| 3159 | |
Luciano Coelho | f29f58a | 2014-05-07 20:05:12 +0300 | [diff] [blame] | 3160 | static int |
| 3161 | __ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev, |
| 3162 | struct cfg80211_csa_settings *params) |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3163 | { |
| 3164 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3165 | struct ieee80211_local *local = sdata->local; |
Luciano Coelho | 6d027bc | 2014-10-08 09:48:37 +0300 | [diff] [blame] | 3166 | struct ieee80211_channel_switch ch_switch; |
Michal Kazior | 2b32713 | 2014-04-09 15:29:32 +0200 | [diff] [blame] | 3167 | struct ieee80211_chanctx_conf *conf; |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3168 | struct ieee80211_chanctx *chanctx; |
Johannes Berg | b08cc24 | 2014-10-20 21:36:04 +0200 | [diff] [blame] | 3169 | u32 changed = 0; |
| 3170 | int err; |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3171 | |
Michal Kazior | dbd7285 | 2014-01-29 07:56:21 +0100 | [diff] [blame] | 3172 | sdata_assert_lock(sdata); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3173 | lockdep_assert_held(&local->mtx); |
Simon Wunderlich | 7ca133b | 2013-11-21 18:19:50 +0100 | [diff] [blame] | 3174 | |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3175 | if (!list_empty(&local->roc_list) || local->scanning) |
| 3176 | return -EBUSY; |
| 3177 | |
| 3178 | if (sdata->wdev.cac_started) |
| 3179 | return -EBUSY; |
| 3180 | |
| 3181 | if (cfg80211_chandef_identical(¶ms->chandef, |
| 3182 | &sdata->vif.bss_conf.chandef)) |
| 3183 | return -EINVAL; |
| 3184 | |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3185 | /* don't allow another channel switch if one is already active. */ |
| 3186 | if (sdata->vif.csa_active) |
| 3187 | return -EBUSY; |
| 3188 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 3189 | mutex_lock(&local->chanctx_mtx); |
| 3190 | conf = rcu_dereference_protected(sdata->vif.chanctx_conf, |
| 3191 | lockdep_is_held(&local->chanctx_mtx)); |
| 3192 | if (!conf) { |
| 3193 | err = -EBUSY; |
| 3194 | goto out; |
| 3195 | } |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3196 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 3197 | chanctx = container_of(conf, struct ieee80211_chanctx, conf); |
| 3198 | if (!chanctx) { |
| 3199 | err = -EBUSY; |
| 3200 | goto out; |
| 3201 | } |
| 3202 | |
Luciano Coelho | 000baa5 | 2014-11-07 15:28:33 +0200 | [diff] [blame] | 3203 | ch_switch.timestamp = 0; |
| 3204 | ch_switch.device_timestamp = 0; |
| 3205 | ch_switch.block_tx = params->block_tx; |
| 3206 | ch_switch.chandef = params->chandef; |
| 3207 | ch_switch.count = params->count; |
| 3208 | |
Luciano Coelho | 6d027bc | 2014-10-08 09:48:37 +0300 | [diff] [blame] | 3209 | err = drv_pre_channel_switch(sdata, &ch_switch); |
| 3210 | if (err) |
| 3211 | goto out; |
| 3212 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 3213 | err = ieee80211_vif_reserve_chanctx(sdata, ¶ms->chandef, |
| 3214 | chanctx->mode, |
| 3215 | params->radar_required); |
| 3216 | if (err) |
| 3217 | goto out; |
| 3218 | |
| 3219 | /* if reservation is invalid then this will fail */ |
| 3220 | err = ieee80211_check_combinations(sdata, NULL, chanctx->mode, 0); |
| 3221 | if (err) { |
| 3222 | ieee80211_vif_unreserve_chanctx(sdata); |
| 3223 | goto out; |
| 3224 | } |
| 3225 | |
| 3226 | err = ieee80211_set_csa_beacon(sdata, params, &changed); |
| 3227 | if (err) { |
| 3228 | ieee80211_vif_unreserve_chanctx(sdata); |
| 3229 | goto out; |
| 3230 | } |
| 3231 | |
Luciano Coelho | 33787fc | 2013-11-11 20:34:54 +0200 | [diff] [blame] | 3232 | sdata->csa_chandef = params->chandef; |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3233 | sdata->csa_block_tx = params->block_tx; |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3234 | sdata->vif.csa_active = true; |
| 3235 | |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3236 | if (sdata->csa_block_tx) |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 3237 | ieee80211_stop_vif_queues(local, sdata, |
| 3238 | IEEE80211_QUEUE_STOP_REASON_CSA); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3239 | |
Luciano Coelho | 2f45729 | 2014-11-07 14:31:36 +0200 | [diff] [blame] | 3240 | cfg80211_ch_switch_started_notify(sdata->dev, &sdata->csa_chandef, |
| 3241 | params->count); |
| 3242 | |
Luciano Coelho | 66e01cf | 2014-01-13 19:43:00 +0200 | [diff] [blame] | 3243 | if (changed) { |
| 3244 | ieee80211_bss_info_change_notify(sdata, changed); |
| 3245 | drv_channel_switch_beacon(sdata, ¶ms->chandef); |
| 3246 | } else { |
| 3247 | /* if the beacon didn't change, we can finalize immediately */ |
| 3248 | ieee80211_csa_finalize(sdata); |
| 3249 | } |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3250 | |
Michal Kazior | 03078de | 2014-06-25 12:35:08 +0200 | [diff] [blame] | 3251 | out: |
| 3252 | mutex_unlock(&local->chanctx_mtx); |
| 3253 | return err; |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3254 | } |
| 3255 | |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 3256 | int ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev, |
| 3257 | struct cfg80211_csa_settings *params) |
| 3258 | { |
| 3259 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3260 | struct ieee80211_local *local = sdata->local; |
| 3261 | int err; |
| 3262 | |
| 3263 | mutex_lock(&local->mtx); |
| 3264 | err = __ieee80211_channel_switch(wiphy, dev, params); |
| 3265 | mutex_unlock(&local->mtx); |
| 3266 | |
| 3267 | return err; |
| 3268 | } |
| 3269 | |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3270 | static struct sk_buff *ieee80211_make_ack_skb(struct ieee80211_local *local, |
| 3271 | struct sk_buff *skb, u64 *cookie, |
| 3272 | gfp_t gfp) |
| 3273 | { |
| 3274 | unsigned long spin_flags; |
| 3275 | struct sk_buff *ack_skb; |
| 3276 | int id; |
| 3277 | |
| 3278 | ack_skb = skb_copy(skb, gfp); |
| 3279 | if (!ack_skb) |
| 3280 | return ERR_PTR(-ENOMEM); |
| 3281 | |
| 3282 | spin_lock_irqsave(&local->ack_status_lock, spin_flags); |
| 3283 | id = idr_alloc(&local->ack_status_frames, ack_skb, |
| 3284 | 1, 0x10000, GFP_ATOMIC); |
| 3285 | spin_unlock_irqrestore(&local->ack_status_lock, spin_flags); |
| 3286 | |
| 3287 | if (id < 0) { |
| 3288 | kfree_skb(ack_skb); |
| 3289 | return ERR_PTR(-ENOMEM); |
| 3290 | } |
| 3291 | |
| 3292 | IEEE80211_SKB_CB(skb)->ack_frame_id = id; |
| 3293 | |
| 3294 | *cookie = ieee80211_mgmt_tx_cookie(local); |
| 3295 | IEEE80211_SKB_CB(ack_skb)->ack.cookie = *cookie; |
| 3296 | |
| 3297 | return ack_skb; |
| 3298 | } |
| 3299 | |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 3300 | static int ieee80211_mgmt_tx(struct wiphy *wiphy, struct wireless_dev *wdev, |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3301 | struct cfg80211_mgmt_tx_params *params, |
| 3302 | u64 *cookie) |
Jouni Malinen | 026331c | 2010-02-15 12:53:10 +0200 | [diff] [blame] | 3303 | { |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 3304 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3305 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 3306 | struct sk_buff *skb, *ack_skb; |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3307 | struct sta_info *sta; |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3308 | const struct ieee80211_mgmt *mgmt = (void *)params->buf; |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3309 | bool need_offchan = false; |
Johannes Berg | e247bd90 | 2011-11-04 11:18:21 +0100 | [diff] [blame] | 3310 | u32 flags; |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3311 | int ret; |
Andrei Otcheretianski | 387910c | 2014-05-09 14:11:45 +0300 | [diff] [blame] | 3312 | u8 *data; |
Johannes Berg | f7ca38d | 2010-11-25 10:02:29 +0100 | [diff] [blame] | 3313 | |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3314 | if (params->dont_wait_for_ack) |
Johannes Berg | e247bd90 | 2011-11-04 11:18:21 +0100 | [diff] [blame] | 3315 | flags = IEEE80211_TX_CTL_NO_ACK; |
| 3316 | else |
| 3317 | flags = IEEE80211_TX_INTFL_NL80211_FRAME_TX | |
| 3318 | IEEE80211_TX_CTL_REQ_TX_STATUS; |
| 3319 | |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3320 | if (params->no_cck) |
Rajkumar Manoharan | aad14ce | 2011-09-25 14:53:31 +0530 | [diff] [blame] | 3321 | flags |= IEEE80211_TX_CTL_NO_CCK_RATE; |
| 3322 | |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3323 | switch (sdata->vif.type) { |
| 3324 | case NL80211_IFTYPE_ADHOC: |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3325 | if (!sdata->vif.bss_conf.ibss_joined) |
| 3326 | need_offchan = true; |
| 3327 | /* fall through */ |
| 3328 | #ifdef CONFIG_MAC80211_MESH |
| 3329 | case NL80211_IFTYPE_MESH_POINT: |
| 3330 | if (ieee80211_vif_is_mesh(&sdata->vif) && |
| 3331 | !sdata->u.mesh.mesh_id_len) |
| 3332 | need_offchan = true; |
| 3333 | /* fall through */ |
| 3334 | #endif |
Johannes Berg | 663fcaf | 2010-09-30 21:06:09 +0200 | [diff] [blame] | 3335 | case NL80211_IFTYPE_AP: |
| 3336 | case NL80211_IFTYPE_AP_VLAN: |
| 3337 | case NL80211_IFTYPE_P2P_GO: |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3338 | if (sdata->vif.type != NL80211_IFTYPE_ADHOC && |
| 3339 | !ieee80211_vif_is_mesh(&sdata->vif) && |
| 3340 | !rcu_access_pointer(sdata->bss->beacon)) |
| 3341 | need_offchan = true; |
Johannes Berg | 663fcaf | 2010-09-30 21:06:09 +0200 | [diff] [blame] | 3342 | if (!ieee80211_is_action(mgmt->frame_control) || |
Thomas Pedersen | ac49e1a | 2013-06-20 23:50:58 -0700 | [diff] [blame] | 3343 | mgmt->u.action.category == WLAN_CATEGORY_PUBLIC || |
Simon Wunderlich | cd7760e | 2013-08-28 13:41:31 +0200 | [diff] [blame] | 3344 | mgmt->u.action.category == WLAN_CATEGORY_SELF_PROTECTED || |
| 3345 | mgmt->u.action.category == WLAN_CATEGORY_SPECTRUM_MGMT) |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3346 | break; |
| 3347 | rcu_read_lock(); |
| 3348 | sta = sta_info_get(sdata, mgmt->da); |
| 3349 | rcu_read_unlock(); |
| 3350 | if (!sta) |
| 3351 | return -ENOLINK; |
| 3352 | break; |
| 3353 | case NL80211_IFTYPE_STATION: |
Johannes Berg | 663fcaf | 2010-09-30 21:06:09 +0200 | [diff] [blame] | 3354 | case NL80211_IFTYPE_P2P_CLIENT: |
Matti Gottlieb | b8e69d5 | 2015-04-20 22:54:14 +0300 | [diff] [blame] | 3355 | sdata_lock(sdata); |
| 3356 | if (!sdata->u.mgd.associated || |
| 3357 | (params->offchan && params->wait && |
| 3358 | local->ops->remain_on_channel && |
| 3359 | memcmp(sdata->u.mgd.associated->bssid, |
| 3360 | mgmt->bssid, ETH_ALEN))) |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3361 | need_offchan = true; |
Matti Gottlieb | b8e69d5 | 2015-04-20 22:54:14 +0300 | [diff] [blame] | 3362 | sdata_unlock(sdata); |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3363 | break; |
Johannes Berg | f142c6b | 2012-06-18 20:07:15 +0200 | [diff] [blame] | 3364 | case NL80211_IFTYPE_P2P_DEVICE: |
| 3365 | need_offchan = true; |
| 3366 | break; |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3367 | default: |
| 3368 | return -EOPNOTSUPP; |
| 3369 | } |
| 3370 | |
Antonio Quartulli | f7aeb6f | 2013-06-11 14:20:00 +0200 | [diff] [blame] | 3371 | /* configurations requiring offchan cannot work if no channel has been |
| 3372 | * specified |
| 3373 | */ |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3374 | if (need_offchan && !params->chan) |
Antonio Quartulli | f7aeb6f | 2013-06-11 14:20:00 +0200 | [diff] [blame] | 3375 | return -EINVAL; |
| 3376 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3377 | mutex_lock(&local->mtx); |
| 3378 | |
| 3379 | /* Check if the operating channel is the requested channel */ |
| 3380 | if (!need_offchan) { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3381 | struct ieee80211_chanctx_conf *chanctx_conf; |
| 3382 | |
| 3383 | rcu_read_lock(); |
| 3384 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 3385 | |
Antonio Quartulli | f7aeb6f | 2013-06-11 14:20:00 +0200 | [diff] [blame] | 3386 | if (chanctx_conf) { |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3387 | need_offchan = params->chan && |
| 3388 | (params->chan != |
| 3389 | chanctx_conf->def.chan); |
| 3390 | } else if (!params->chan) { |
Antonio Quartulli | f7aeb6f | 2013-06-11 14:20:00 +0200 | [diff] [blame] | 3391 | ret = -EINVAL; |
| 3392 | rcu_read_unlock(); |
| 3393 | goto out_unlock; |
| 3394 | } else { |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3395 | need_offchan = true; |
Antonio Quartulli | f7aeb6f | 2013-06-11 14:20:00 +0200 | [diff] [blame] | 3396 | } |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3397 | rcu_read_unlock(); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3398 | } |
| 3399 | |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3400 | if (need_offchan && !params->offchan) { |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3401 | ret = -EBUSY; |
| 3402 | goto out_unlock; |
| 3403 | } |
| 3404 | |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3405 | skb = dev_alloc_skb(local->hw.extra_tx_headroom + params->len); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3406 | if (!skb) { |
| 3407 | ret = -ENOMEM; |
| 3408 | goto out_unlock; |
| 3409 | } |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3410 | skb_reserve(skb, local->hw.extra_tx_headroom); |
| 3411 | |
Andrei Otcheretianski | 387910c | 2014-05-09 14:11:45 +0300 | [diff] [blame] | 3412 | data = skb_put(skb, params->len); |
| 3413 | memcpy(data, params->buf, params->len); |
| 3414 | |
| 3415 | /* Update CSA counters */ |
| 3416 | if (sdata->vif.csa_active && |
| 3417 | (sdata->vif.type == NL80211_IFTYPE_AP || |
Chun-Yeow Yeoh | 8df734e | 2015-06-09 13:35:33 +0800 | [diff] [blame] | 3418 | sdata->vif.type == NL80211_IFTYPE_MESH_POINT || |
Andrei Otcheretianski | 387910c | 2014-05-09 14:11:45 +0300 | [diff] [blame] | 3419 | sdata->vif.type == NL80211_IFTYPE_ADHOC) && |
| 3420 | params->n_csa_offsets) { |
| 3421 | int i; |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 3422 | struct beacon_data *beacon = NULL; |
Andrei Otcheretianski | 387910c | 2014-05-09 14:11:45 +0300 | [diff] [blame] | 3423 | |
Michal Kazior | af296bd | 2014-06-05 14:21:36 +0200 | [diff] [blame] | 3424 | rcu_read_lock(); |
| 3425 | |
| 3426 | if (sdata->vif.type == NL80211_IFTYPE_AP) |
| 3427 | beacon = rcu_dereference(sdata->u.ap.beacon); |
| 3428 | else if (sdata->vif.type == NL80211_IFTYPE_ADHOC) |
| 3429 | beacon = rcu_dereference(sdata->u.ibss.presp); |
| 3430 | else if (ieee80211_vif_is_mesh(&sdata->vif)) |
| 3431 | beacon = rcu_dereference(sdata->u.mesh.beacon); |
| 3432 | |
| 3433 | if (beacon) |
| 3434 | for (i = 0; i < params->n_csa_offsets; i++) |
| 3435 | data[params->csa_offsets[i]] = |
| 3436 | beacon->csa_current_counter; |
| 3437 | |
| 3438 | rcu_read_unlock(); |
Andrei Otcheretianski | 387910c | 2014-05-09 14:11:45 +0300 | [diff] [blame] | 3439 | } |
Johannes Berg | 9d38d85 | 2010-06-09 17:20:33 +0200 | [diff] [blame] | 3440 | |
| 3441 | IEEE80211_SKB_CB(skb)->flags = flags; |
| 3442 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3443 | skb->dev = sdata->dev; |
| 3444 | |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 3445 | if (!params->dont_wait_for_ack) { |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3446 | /* make a copy to preserve the frame contents |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 3447 | * in case of encryption. |
| 3448 | */ |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3449 | ack_skb = ieee80211_make_ack_skb(local, skb, cookie, |
| 3450 | GFP_KERNEL); |
| 3451 | if (IS_ERR(ack_skb)) { |
| 3452 | ret = PTR_ERR(ack_skb); |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 3453 | kfree_skb(skb); |
| 3454 | goto out_unlock; |
| 3455 | } |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 3456 | } else { |
Johannes Berg | c1df932 | 2015-11-27 21:59:41 +0100 | [diff] [blame] | 3457 | /* Assign a dummy non-zero cookie, it's not sent to |
| 3458 | * userspace in this case but we rely on its value |
| 3459 | * internally in the need_offchan case to distinguish |
| 3460 | * mgmt-tx from remain-on-channel. |
| 3461 | */ |
| 3462 | *cookie = 0xffffffff; |
Johannes Berg | b2eb0ee | 2015-06-01 22:54:13 +0200 | [diff] [blame] | 3463 | } |
| 3464 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3465 | if (!need_offchan) { |
| 3466 | ieee80211_tx_skb(sdata, skb); |
| 3467 | ret = 0; |
| 3468 | goto out_unlock; |
| 3469 | } |
| 3470 | |
Seth Forshee | 6c17b77 | 2013-02-11 11:21:07 -0600 | [diff] [blame] | 3471 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_TX_OFFCHAN | |
| 3472 | IEEE80211_TX_INTFL_OFFCHAN_TX_OK; |
Johannes Berg | 30686bf | 2015-06-02 21:39:54 +0200 | [diff] [blame] | 3473 | if (ieee80211_hw_check(&local->hw, QUEUE_CONTROL)) |
Johannes Berg | 3a25a8c | 2012-04-03 16:28:50 +0200 | [diff] [blame] | 3474 | IEEE80211_SKB_CB(skb)->hw_queue = |
| 3475 | local->hw.offchannel_tx_hw_queue; |
| 3476 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3477 | /* This will handle all kinds of coalescing and immediate TX */ |
Andrei Otcheretianski | b176e62 | 2013-11-18 19:06:49 +0200 | [diff] [blame] | 3478 | ret = ieee80211_start_roc_work(local, sdata, params->chan, |
| 3479 | params->wait, cookie, skb, |
Ilan Peer | d339d5c | 2013-02-12 09:34:13 +0200 | [diff] [blame] | 3480 | IEEE80211_ROC_TYPE_MGMT_TX); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3481 | if (ret) |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 3482 | kfree_skb(skb); |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3483 | out_unlock: |
| 3484 | mutex_unlock(&local->mtx); |
| 3485 | return ret; |
Jouni Malinen | 026331c | 2010-02-15 12:53:10 +0200 | [diff] [blame] | 3486 | } |
| 3487 | |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 3488 | static int ieee80211_mgmt_tx_cancel_wait(struct wiphy *wiphy, |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 3489 | struct wireless_dev *wdev, |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 3490 | u64 cookie) |
| 3491 | { |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 3492 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 3493 | |
Johannes Berg | 2eb278e | 2012-06-05 14:28:42 +0200 | [diff] [blame] | 3494 | return ieee80211_cancel_roc(local, cookie, true); |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 3495 | } |
| 3496 | |
Johannes Berg | 7be5086 | 2010-10-13 12:06:24 +0200 | [diff] [blame] | 3497 | static void ieee80211_mgmt_frame_register(struct wiphy *wiphy, |
Johannes Berg | 71bbc99 | 2012-06-15 15:30:18 +0200 | [diff] [blame] | 3498 | struct wireless_dev *wdev, |
Johannes Berg | 7be5086 | 2010-10-13 12:06:24 +0200 | [diff] [blame] | 3499 | u16 frame_type, bool reg) |
| 3500 | { |
| 3501 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Andrei Otcheretianski | 1b09b55 | 2015-08-15 22:39:50 +0300 | [diff] [blame] | 3502 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Johannes Berg | 7be5086 | 2010-10-13 12:06:24 +0200 | [diff] [blame] | 3503 | |
Will Hawkins | 6abe056 | 2012-06-20 11:51:14 -0400 | [diff] [blame] | 3504 | switch (frame_type) { |
Will Hawkins | 6abe056 | 2012-06-20 11:51:14 -0400 | [diff] [blame] | 3505 | case IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ: |
Andrei Otcheretianski | 1b09b55 | 2015-08-15 22:39:50 +0300 | [diff] [blame] | 3506 | if (reg) { |
Will Hawkins | 6abe056 | 2012-06-20 11:51:14 -0400 | [diff] [blame] | 3507 | local->probe_req_reg++; |
Andrei Otcheretianski | 1b09b55 | 2015-08-15 22:39:50 +0300 | [diff] [blame] | 3508 | sdata->vif.probe_req_reg++; |
| 3509 | } else { |
| 3510 | if (local->probe_req_reg) |
| 3511 | local->probe_req_reg--; |
| 3512 | |
| 3513 | if (sdata->vif.probe_req_reg) |
| 3514 | sdata->vif.probe_req_reg--; |
| 3515 | } |
Johannes Berg | 7be5086 | 2010-10-13 12:06:24 +0200 | [diff] [blame] | 3516 | |
Felix Fietkau | 35f5149 | 2012-10-31 15:50:34 +0100 | [diff] [blame] | 3517 | if (!local->open_count) |
| 3518 | break; |
| 3519 | |
Andrei Otcheretianski | 1b09b55 | 2015-08-15 22:39:50 +0300 | [diff] [blame] | 3520 | if (sdata->vif.probe_req_reg == 1) |
| 3521 | drv_config_iface_filter(local, sdata, FIF_PROBE_REQ, |
| 3522 | FIF_PROBE_REQ); |
| 3523 | else if (sdata->vif.probe_req_reg == 0) |
| 3524 | drv_config_iface_filter(local, sdata, 0, |
| 3525 | FIF_PROBE_REQ); |
| 3526 | |
| 3527 | ieee80211_configure_filter(local); |
Will Hawkins | 6abe056 | 2012-06-20 11:51:14 -0400 | [diff] [blame] | 3528 | break; |
| 3529 | default: |
| 3530 | break; |
| 3531 | } |
Johannes Berg | 7be5086 | 2010-10-13 12:06:24 +0200 | [diff] [blame] | 3532 | } |
| 3533 | |
Bruno Randolf | 15d9675 | 2010-11-10 12:50:56 +0900 | [diff] [blame] | 3534 | static int ieee80211_set_antenna(struct wiphy *wiphy, u32 tx_ant, u32 rx_ant) |
| 3535 | { |
| 3536 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 3537 | |
| 3538 | if (local->started) |
| 3539 | return -EOPNOTSUPP; |
| 3540 | |
| 3541 | return drv_set_antenna(local, tx_ant, rx_ant); |
| 3542 | } |
| 3543 | |
| 3544 | static int ieee80211_get_antenna(struct wiphy *wiphy, u32 *tx_ant, u32 *rx_ant) |
| 3545 | { |
| 3546 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 3547 | |
| 3548 | return drv_get_antenna(local, tx_ant, rx_ant); |
| 3549 | } |
| 3550 | |
Johannes Berg | c68f4b8 | 2011-07-05 16:35:41 +0200 | [diff] [blame] | 3551 | static int ieee80211_set_rekey_data(struct wiphy *wiphy, |
| 3552 | struct net_device *dev, |
| 3553 | struct cfg80211_gtk_rekey_data *data) |
| 3554 | { |
| 3555 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 3556 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3557 | |
| 3558 | if (!local->ops->set_rekey_data) |
| 3559 | return -EOPNOTSUPP; |
| 3560 | |
| 3561 | drv_set_rekey_data(local, sdata, data); |
| 3562 | |
| 3563 | return 0; |
| 3564 | } |
| 3565 | |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3566 | static int ieee80211_probe_client(struct wiphy *wiphy, struct net_device *dev, |
| 3567 | const u8 *peer, u64 *cookie) |
| 3568 | { |
| 3569 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3570 | struct ieee80211_local *local = sdata->local; |
| 3571 | struct ieee80211_qos_hdr *nullfunc; |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3572 | struct sk_buff *skb, *ack_skb; |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3573 | int size = sizeof(*nullfunc); |
| 3574 | __le16 fc; |
| 3575 | bool qos; |
| 3576 | struct ieee80211_tx_info *info; |
| 3577 | struct sta_info *sta; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3578 | struct ieee80211_chanctx_conf *chanctx_conf; |
| 3579 | enum ieee80211_band band; |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3580 | int ret; |
| 3581 | |
| 3582 | /* the lock is needed to assign the cookie later */ |
| 3583 | mutex_lock(&local->mtx); |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3584 | |
| 3585 | rcu_read_lock(); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3586 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 3587 | if (WARN_ON(!chanctx_conf)) { |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3588 | ret = -EINVAL; |
| 3589 | goto unlock; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3590 | } |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 3591 | band = chanctx_conf->def.chan->band; |
Felix Fietkau | 03bb7f4 | 2013-09-29 21:39:33 +0200 | [diff] [blame] | 3592 | sta = sta_info_get_bss(sdata, peer); |
Johannes Berg | b4487c2 | 2011-11-11 20:22:30 +0100 | [diff] [blame] | 3593 | if (sta) { |
Johannes Berg | a74a8c8 | 2014-07-22 14:50:47 +0200 | [diff] [blame] | 3594 | qos = sta->sta.wme; |
Johannes Berg | b4487c2 | 2011-11-11 20:22:30 +0100 | [diff] [blame] | 3595 | } else { |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3596 | ret = -ENOLINK; |
| 3597 | goto unlock; |
Johannes Berg | b4487c2 | 2011-11-11 20:22:30 +0100 | [diff] [blame] | 3598 | } |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3599 | |
| 3600 | if (qos) { |
| 3601 | fc = cpu_to_le16(IEEE80211_FTYPE_DATA | |
| 3602 | IEEE80211_STYPE_QOS_NULLFUNC | |
| 3603 | IEEE80211_FCTL_FROMDS); |
| 3604 | } else { |
| 3605 | size -= 2; |
| 3606 | fc = cpu_to_le16(IEEE80211_FTYPE_DATA | |
| 3607 | IEEE80211_STYPE_NULLFUNC | |
| 3608 | IEEE80211_FCTL_FROMDS); |
| 3609 | } |
| 3610 | |
| 3611 | skb = dev_alloc_skb(local->hw.extra_tx_headroom + size); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3612 | if (!skb) { |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3613 | ret = -ENOMEM; |
| 3614 | goto unlock; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3615 | } |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3616 | |
| 3617 | skb->dev = dev; |
| 3618 | |
| 3619 | skb_reserve(skb, local->hw.extra_tx_headroom); |
| 3620 | |
| 3621 | nullfunc = (void *) skb_put(skb, size); |
| 3622 | nullfunc->frame_control = fc; |
| 3623 | nullfunc->duration_id = 0; |
| 3624 | memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN); |
| 3625 | memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN); |
| 3626 | memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN); |
| 3627 | nullfunc->seq_ctrl = 0; |
| 3628 | |
| 3629 | info = IEEE80211_SKB_CB(skb); |
| 3630 | |
| 3631 | info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS | |
| 3632 | IEEE80211_TX_INTFL_NL80211_FRAME_TX; |
Johannes Berg | 73c4e19 | 2014-11-09 18:50:09 +0200 | [diff] [blame] | 3633 | info->band = band; |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3634 | |
| 3635 | skb_set_queue_mapping(skb, IEEE80211_AC_VO); |
| 3636 | skb->priority = 7; |
| 3637 | if (qos) |
| 3638 | nullfunc->qos_ctrl = cpu_to_le16(7); |
| 3639 | |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3640 | ack_skb = ieee80211_make_ack_skb(local, skb, cookie, GFP_ATOMIC); |
| 3641 | if (IS_ERR(ack_skb)) { |
| 3642 | kfree_skb(skb); |
| 3643 | ret = PTR_ERR(ack_skb); |
| 3644 | goto unlock; |
| 3645 | } |
| 3646 | |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3647 | local_bh_disable(); |
Johannes Berg | 7c10770 | 2015-03-20 14:18:27 +0100 | [diff] [blame] | 3648 | ieee80211_xmit(sdata, sta, skb); |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3649 | local_bh_enable(); |
| 3650 | |
Johannes Berg | 3b79af9 | 2015-06-01 23:14:59 +0200 | [diff] [blame] | 3651 | ret = 0; |
| 3652 | unlock: |
| 3653 | rcu_read_unlock(); |
| 3654 | mutex_unlock(&local->mtx); |
| 3655 | |
| 3656 | return ret; |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3657 | } |
| 3658 | |
Johannes Berg | 683b6d3 | 2012-11-08 21:25:48 +0100 | [diff] [blame] | 3659 | static int ieee80211_cfg_get_channel(struct wiphy *wiphy, |
| 3660 | struct wireless_dev *wdev, |
| 3661 | struct cfg80211_chan_def *chandef) |
Johannes Berg | 5b7ccaf | 2012-07-12 19:45:08 +0200 | [diff] [blame] | 3662 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3663 | struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev); |
Felix Fietkau | cb601ff | 2013-02-23 19:02:14 +0100 | [diff] [blame] | 3664 | struct ieee80211_local *local = wiphy_priv(wiphy); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3665 | struct ieee80211_chanctx_conf *chanctx_conf; |
Johannes Berg | 683b6d3 | 2012-11-08 21:25:48 +0100 | [diff] [blame] | 3666 | int ret = -ENODATA; |
Johannes Berg | 5b7ccaf | 2012-07-12 19:45:08 +0200 | [diff] [blame] | 3667 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3668 | rcu_read_lock(); |
Johannes Berg | feda302 | 2013-02-28 09:59:22 +0100 | [diff] [blame] | 3669 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 3670 | if (chanctx_conf) { |
Luciano Coelho | c12bc48 | 2014-09-30 07:08:02 +0300 | [diff] [blame] | 3671 | *chandef = sdata->vif.bss_conf.chandef; |
Johannes Berg | feda302 | 2013-02-28 09:59:22 +0100 | [diff] [blame] | 3672 | ret = 0; |
| 3673 | } else if (local->open_count > 0 && |
| 3674 | local->open_count == local->monitors && |
| 3675 | sdata->vif.type == NL80211_IFTYPE_MONITOR) { |
| 3676 | if (local->use_chanctx) |
| 3677 | *chandef = local->monitor_chandef; |
| 3678 | else |
Karl Beldan | 675a0b0 | 2013-03-25 16:26:57 +0100 | [diff] [blame] | 3679 | *chandef = local->_oper_chandef; |
Johannes Berg | 683b6d3 | 2012-11-08 21:25:48 +0100 | [diff] [blame] | 3680 | ret = 0; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3681 | } |
| 3682 | rcu_read_unlock(); |
| 3683 | |
Johannes Berg | 683b6d3 | 2012-11-08 21:25:48 +0100 | [diff] [blame] | 3684 | return ret; |
Johannes Berg | 5b7ccaf | 2012-07-12 19:45:08 +0200 | [diff] [blame] | 3685 | } |
| 3686 | |
Johannes Berg | 6d52563 | 2012-04-04 15:05:25 +0200 | [diff] [blame] | 3687 | #ifdef CONFIG_PM |
| 3688 | static void ieee80211_set_wakeup(struct wiphy *wiphy, bool enabled) |
| 3689 | { |
| 3690 | drv_set_wakeup(wiphy_priv(wiphy), enabled); |
| 3691 | } |
| 3692 | #endif |
| 3693 | |
Kyeyoon Park | 32db6b5 | 2013-12-16 23:04:43 -0800 | [diff] [blame] | 3694 | static int ieee80211_set_qos_map(struct wiphy *wiphy, |
| 3695 | struct net_device *dev, |
| 3696 | struct cfg80211_qos_map *qos_map) |
| 3697 | { |
| 3698 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3699 | struct mac80211_qos_map *new_qos_map, *old_qos_map; |
| 3700 | |
| 3701 | if (qos_map) { |
| 3702 | new_qos_map = kzalloc(sizeof(*new_qos_map), GFP_KERNEL); |
| 3703 | if (!new_qos_map) |
| 3704 | return -ENOMEM; |
| 3705 | memcpy(&new_qos_map->qos_map, qos_map, sizeof(*qos_map)); |
| 3706 | } else { |
| 3707 | /* A NULL qos_map was passed to disable QoS mapping */ |
| 3708 | new_qos_map = NULL; |
| 3709 | } |
| 3710 | |
Johannes Berg | 194ff52 | 2013-12-30 23:12:37 +0100 | [diff] [blame] | 3711 | old_qos_map = sdata_dereference(sdata->qos_map, sdata); |
Kyeyoon Park | 32db6b5 | 2013-12-16 23:04:43 -0800 | [diff] [blame] | 3712 | rcu_assign_pointer(sdata->qos_map, new_qos_map); |
| 3713 | if (old_qos_map) |
| 3714 | kfree_rcu(old_qos_map, rcu_head); |
| 3715 | |
| 3716 | return 0; |
| 3717 | } |
| 3718 | |
Jouni Malinen | 3b1700b | 2014-04-28 11:22:25 +0300 | [diff] [blame] | 3719 | static int ieee80211_set_ap_chanwidth(struct wiphy *wiphy, |
| 3720 | struct net_device *dev, |
| 3721 | struct cfg80211_chan_def *chandef) |
| 3722 | { |
| 3723 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3724 | int ret; |
| 3725 | u32 changed = 0; |
| 3726 | |
| 3727 | ret = ieee80211_vif_change_bandwidth(sdata, chandef, &changed); |
| 3728 | if (ret == 0) |
| 3729 | ieee80211_bss_info_change_notify(sdata, changed); |
| 3730 | |
| 3731 | return ret; |
| 3732 | } |
| 3733 | |
Johannes Berg | 02219b3 | 2014-10-07 10:38:50 +0300 | [diff] [blame] | 3734 | static int ieee80211_add_tx_ts(struct wiphy *wiphy, struct net_device *dev, |
| 3735 | u8 tsid, const u8 *peer, u8 up, |
| 3736 | u16 admitted_time) |
| 3737 | { |
| 3738 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3739 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3740 | int ac = ieee802_1d_to_ac[up]; |
| 3741 | |
| 3742 | if (sdata->vif.type != NL80211_IFTYPE_STATION) |
| 3743 | return -EOPNOTSUPP; |
| 3744 | |
| 3745 | if (!(sdata->wmm_acm & BIT(up))) |
| 3746 | return -EINVAL; |
| 3747 | |
| 3748 | if (ifmgd->tx_tspec[ac].admitted_time) |
| 3749 | return -EBUSY; |
| 3750 | |
| 3751 | if (admitted_time) { |
| 3752 | ifmgd->tx_tspec[ac].admitted_time = 32 * admitted_time; |
| 3753 | ifmgd->tx_tspec[ac].tsid = tsid; |
| 3754 | ifmgd->tx_tspec[ac].up = up; |
| 3755 | } |
| 3756 | |
| 3757 | return 0; |
| 3758 | } |
| 3759 | |
| 3760 | static int ieee80211_del_tx_ts(struct wiphy *wiphy, struct net_device *dev, |
| 3761 | u8 tsid, const u8 *peer) |
| 3762 | { |
| 3763 | struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev); |
| 3764 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3765 | struct ieee80211_local *local = wiphy_priv(wiphy); |
| 3766 | int ac; |
| 3767 | |
| 3768 | for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) { |
| 3769 | struct ieee80211_sta_tx_tspec *tx_tspec = &ifmgd->tx_tspec[ac]; |
| 3770 | |
| 3771 | /* skip unused entries */ |
| 3772 | if (!tx_tspec->admitted_time) |
| 3773 | continue; |
| 3774 | |
| 3775 | if (tx_tspec->tsid != tsid) |
| 3776 | continue; |
| 3777 | |
| 3778 | /* due to this new packets will be reassigned to non-ACM ACs */ |
| 3779 | tx_tspec->up = -1; |
| 3780 | |
| 3781 | /* Make sure that all packets have been sent to avoid to |
| 3782 | * restore the QoS params on packets that are still on the |
| 3783 | * queues. |
| 3784 | */ |
| 3785 | synchronize_net(); |
Emmanuel Grumbach | 3b24f4c | 2015-01-07 15:42:39 +0200 | [diff] [blame] | 3786 | ieee80211_flush_queues(local, sdata, false); |
Johannes Berg | 02219b3 | 2014-10-07 10:38:50 +0300 | [diff] [blame] | 3787 | |
| 3788 | /* restore the normal QoS parameters |
| 3789 | * (unconditionally to avoid races) |
| 3790 | */ |
| 3791 | tx_tspec->action = TX_TSPEC_ACTION_STOP_DOWNGRADE; |
| 3792 | tx_tspec->downgraded = false; |
| 3793 | ieee80211_sta_handle_tspec_ac_params(sdata); |
| 3794 | |
| 3795 | /* finally clear all the data */ |
| 3796 | memset(tx_tspec, 0, sizeof(*tx_tspec)); |
| 3797 | |
| 3798 | return 0; |
| 3799 | } |
| 3800 | |
| 3801 | return -ENOENT; |
| 3802 | } |
| 3803 | |
Johannes Berg | 8a47cea | 2014-01-20 23:55:44 +0100 | [diff] [blame] | 3804 | const struct cfg80211_ops mac80211_config_ops = { |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3805 | .add_virtual_intf = ieee80211_add_iface, |
| 3806 | .del_virtual_intf = ieee80211_del_iface, |
Johannes Berg | 42613db | 2007-09-28 21:52:27 +0200 | [diff] [blame] | 3807 | .change_virtual_intf = ieee80211_change_iface, |
Johannes Berg | f142c6b | 2012-06-18 20:07:15 +0200 | [diff] [blame] | 3808 | .start_p2p_device = ieee80211_start_p2p_device, |
| 3809 | .stop_p2p_device = ieee80211_stop_p2p_device, |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 3810 | .add_key = ieee80211_add_key, |
| 3811 | .del_key = ieee80211_del_key, |
Johannes Berg | 62da92f | 2007-12-19 02:03:31 +0100 | [diff] [blame] | 3812 | .get_key = ieee80211_get_key, |
Johannes Berg | e8cbb4c | 2007-12-19 02:03:30 +0100 | [diff] [blame] | 3813 | .set_default_key = ieee80211_config_default_key, |
Jouni Malinen | 3cfcf6ac | 2009-01-08 13:32:02 +0200 | [diff] [blame] | 3814 | .set_default_mgmt_key = ieee80211_config_default_mgmt_key, |
Johannes Berg | 8860020 | 2012-02-13 15:17:18 +0100 | [diff] [blame] | 3815 | .start_ap = ieee80211_start_ap, |
| 3816 | .change_beacon = ieee80211_change_beacon, |
| 3817 | .stop_ap = ieee80211_stop_ap, |
Johannes Berg | 4fd6931 | 2007-12-19 02:03:35 +0100 | [diff] [blame] | 3818 | .add_station = ieee80211_add_station, |
| 3819 | .del_station = ieee80211_del_station, |
| 3820 | .change_station = ieee80211_change_station, |
Johannes Berg | 7bbdd2d | 2007-12-19 02:03:37 +0100 | [diff] [blame] | 3821 | .get_station = ieee80211_get_station, |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 3822 | .dump_station = ieee80211_dump_station, |
Holger Schurig | 1289723 | 2010-04-19 10:23:57 +0200 | [diff] [blame] | 3823 | .dump_survey = ieee80211_dump_survey, |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 3824 | #ifdef CONFIG_MAC80211_MESH |
| 3825 | .add_mpath = ieee80211_add_mpath, |
| 3826 | .del_mpath = ieee80211_del_mpath, |
| 3827 | .change_mpath = ieee80211_change_mpath, |
| 3828 | .get_mpath = ieee80211_get_mpath, |
| 3829 | .dump_mpath = ieee80211_dump_mpath, |
Henning Rogge | a2db2ed | 2014-09-12 08:58:50 +0200 | [diff] [blame] | 3830 | .get_mpp = ieee80211_get_mpp, |
| 3831 | .dump_mpp = ieee80211_dump_mpp, |
Javier Cardona | 24bdd9f | 2010-12-16 17:37:48 -0800 | [diff] [blame] | 3832 | .update_mesh_config = ieee80211_update_mesh_config, |
| 3833 | .get_mesh_config = ieee80211_get_mesh_config, |
Johannes Berg | 29cbe68 | 2010-12-03 09:20:44 +0100 | [diff] [blame] | 3834 | .join_mesh = ieee80211_join_mesh, |
| 3835 | .leave_mesh = ieee80211_leave_mesh, |
Luis Carlos Cobo | c5dd9c2 | 2008-02-23 15:17:17 +0100 | [diff] [blame] | 3836 | #endif |
Rostislav Lisovy | 239281f | 2014-11-03 10:33:19 +0100 | [diff] [blame] | 3837 | .join_ocb = ieee80211_join_ocb, |
| 3838 | .leave_ocb = ieee80211_leave_ocb, |
Jouni Malinen | 9f1ba90 | 2008-08-07 20:07:01 +0300 | [diff] [blame] | 3839 | .change_bss = ieee80211_change_bss, |
Jouni Malinen | 3188848 | 2008-10-30 16:59:24 +0200 | [diff] [blame] | 3840 | .set_txq_params = ieee80211_set_txq_params, |
Johannes Berg | e8c9bd5 | 2012-06-06 08:18:22 +0200 | [diff] [blame] | 3841 | .set_monitor_channel = ieee80211_set_monitor_channel, |
Bob Copeland | 665af4f | 2009-01-19 11:20:53 -0500 | [diff] [blame] | 3842 | .suspend = ieee80211_suspend, |
| 3843 | .resume = ieee80211_resume, |
Johannes Berg | 2a51931 | 2009-02-10 21:25:55 +0100 | [diff] [blame] | 3844 | .scan = ieee80211_scan, |
Luciano Coelho | 79f460c | 2011-05-11 17:09:36 +0300 | [diff] [blame] | 3845 | .sched_scan_start = ieee80211_sched_scan_start, |
| 3846 | .sched_scan_stop = ieee80211_sched_scan_stop, |
Jouni Malinen | 636a5d3 | 2009-03-19 13:39:22 +0200 | [diff] [blame] | 3847 | .auth = ieee80211_auth, |
| 3848 | .assoc = ieee80211_assoc, |
| 3849 | .deauth = ieee80211_deauth, |
| 3850 | .disassoc = ieee80211_disassoc, |
Johannes Berg | af8cdcd | 2009-04-19 21:25:43 +0200 | [diff] [blame] | 3851 | .join_ibss = ieee80211_join_ibss, |
| 3852 | .leave_ibss = ieee80211_leave_ibss, |
Antonio Quartulli | 391e53e | 2012-11-02 13:27:49 +0100 | [diff] [blame] | 3853 | .set_mcast_rate = ieee80211_set_mcast_rate, |
Jouni Malinen | b9a5f8ca | 2009-04-20 18:39:05 +0200 | [diff] [blame] | 3854 | .set_wiphy_params = ieee80211_set_wiphy_params, |
Johannes Berg | 7643a2c | 2009-06-02 13:01:39 +0200 | [diff] [blame] | 3855 | .set_tx_power = ieee80211_set_tx_power, |
| 3856 | .get_tx_power = ieee80211_get_tx_power, |
Johannes Berg | ab737a4 | 2009-07-01 21:26:58 +0200 | [diff] [blame] | 3857 | .set_wds_peer = ieee80211_set_wds_peer, |
Johannes Berg | 1f87f7d | 2009-06-02 13:01:41 +0200 | [diff] [blame] | 3858 | .rfkill_poll = ieee80211_rfkill_poll, |
Johannes Berg | aff89a9 | 2009-07-01 21:26:51 +0200 | [diff] [blame] | 3859 | CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd) |
Wey-Yi Guy | 71063f0 | 2011-05-20 09:05:54 -0700 | [diff] [blame] | 3860 | CFG80211_TESTMODE_DUMP(ieee80211_testmode_dump) |
Johannes Berg | bc92afd | 2009-07-01 21:26:57 +0200 | [diff] [blame] | 3861 | .set_power_mgmt = ieee80211_set_power_mgmt, |
Johannes Berg | 9930380 | 2009-07-01 21:26:59 +0200 | [diff] [blame] | 3862 | .set_bitrate_mask = ieee80211_set_bitrate_mask, |
Johannes Berg | b8bc4b0 | 2009-12-23 13:15:42 +0100 | [diff] [blame] | 3863 | .remain_on_channel = ieee80211_remain_on_channel, |
| 3864 | .cancel_remain_on_channel = ieee80211_cancel_remain_on_channel, |
Johannes Berg | 2e161f7 | 2010-08-12 15:38:38 +0200 | [diff] [blame] | 3865 | .mgmt_tx = ieee80211_mgmt_tx, |
Johannes Berg | f30221e | 2010-11-25 10:02:30 +0100 | [diff] [blame] | 3866 | .mgmt_tx_cancel_wait = ieee80211_mgmt_tx_cancel_wait, |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 3867 | .set_cqm_rssi_config = ieee80211_set_cqm_rssi_config, |
Johannes Berg | 7be5086 | 2010-10-13 12:06:24 +0200 | [diff] [blame] | 3868 | .mgmt_frame_register = ieee80211_mgmt_frame_register, |
Bruno Randolf | 15d9675 | 2010-11-10 12:50:56 +0900 | [diff] [blame] | 3869 | .set_antenna = ieee80211_set_antenna, |
| 3870 | .get_antenna = ieee80211_get_antenna, |
Johannes Berg | c68f4b8 | 2011-07-05 16:35:41 +0200 | [diff] [blame] | 3871 | .set_rekey_data = ieee80211_set_rekey_data, |
Arik Nemtsov | dfe018b | 2011-09-28 14:12:52 +0300 | [diff] [blame] | 3872 | .tdls_oper = ieee80211_tdls_oper, |
| 3873 | .tdls_mgmt = ieee80211_tdls_mgmt, |
Arik Nemtsov | a7a6bdd | 2014-11-09 18:50:19 +0200 | [diff] [blame] | 3874 | .tdls_channel_switch = ieee80211_tdls_channel_switch, |
| 3875 | .tdls_cancel_channel_switch = ieee80211_tdls_cancel_channel_switch, |
Johannes Berg | 0650073 | 2011-11-04 11:18:16 +0100 | [diff] [blame] | 3876 | .probe_client = ieee80211_probe_client, |
Simon Wunderlich | b53be79 | 2011-11-18 14:20:44 +0100 | [diff] [blame] | 3877 | .set_noack_map = ieee80211_set_noack_map, |
Johannes Berg | 6d52563 | 2012-04-04 15:05:25 +0200 | [diff] [blame] | 3878 | #ifdef CONFIG_PM |
| 3879 | .set_wakeup = ieee80211_set_wakeup, |
| 3880 | #endif |
Johannes Berg | 5b7ccaf | 2012-07-12 19:45:08 +0200 | [diff] [blame] | 3881 | .get_channel = ieee80211_cfg_get_channel, |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 3882 | .start_radar_detection = ieee80211_start_radar_detection, |
Simon Wunderlich | 73da7d5 | 2013-07-11 16:09:06 +0200 | [diff] [blame] | 3883 | .channel_switch = ieee80211_channel_switch, |
Kyeyoon Park | 32db6b5 | 2013-12-16 23:04:43 -0800 | [diff] [blame] | 3884 | .set_qos_map = ieee80211_set_qos_map, |
Jouni Malinen | 3b1700b | 2014-04-28 11:22:25 +0300 | [diff] [blame] | 3885 | .set_ap_chanwidth = ieee80211_set_ap_chanwidth, |
Johannes Berg | 02219b3 | 2014-10-07 10:38:50 +0300 | [diff] [blame] | 3886 | .add_tx_ts = ieee80211_add_tx_ts, |
| 3887 | .del_tx_ts = ieee80211_del_tx_ts, |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3888 | }; |