Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1 | /* |
| 2 | * BSS client mode implementation |
Jouni Malinen | 5394af4 | 2009-01-08 13:31:59 +0200 | [diff] [blame] | 3 | * Copyright 2003-2008, Jouni Malinen <j@w1.fi> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 4 | * Copyright 2004, Instant802 Networks, Inc. |
| 5 | * Copyright 2005, Devicescape Software, Inc. |
| 6 | * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> |
| 7 | * Copyright 2007, Michael Wu <flamingice@sourmilk.net> |
| 8 | * |
| 9 | * This program is free software; you can redistribute it and/or modify |
| 10 | * it under the terms of the GNU General Public License version 2 as |
| 11 | * published by the Free Software Foundation. |
| 12 | */ |
| 13 | |
Geert Uytterhoeven | 5b323ed | 2007-05-08 18:40:27 -0700 | [diff] [blame] | 14 | #include <linux/delay.h> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 15 | #include <linux/if_ether.h> |
| 16 | #include <linux/skbuff.h> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 17 | #include <linux/if_arp.h> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 18 | #include <linux/etherdevice.h> |
Paul Gortmaker | d9b9384 | 2011-09-18 13:21:27 -0400 | [diff] [blame] | 19 | #include <linux/moduleparam.h> |
Johannes Berg | d0709a6 | 2008-02-25 16:27:46 +0100 | [diff] [blame] | 20 | #include <linux/rtnetlink.h> |
Jean Pihet | e8db0be | 2011-08-25 15:35:03 +0200 | [diff] [blame] | 21 | #include <linux/pm_qos.h> |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 22 | #include <linux/crc32.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 23 | #include <linux/slab.h> |
Paul Gortmaker | bc3b2d7 | 2011-07-15 11:47:34 -0400 | [diff] [blame] | 24 | #include <linux/export.h> |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 25 | #include <net/mac80211.h> |
Johannes Berg | 472dbc4 | 2008-09-11 00:01:49 +0200 | [diff] [blame] | 26 | #include <asm/unaligned.h> |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 27 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 28 | #include "ieee80211_i.h" |
Johannes Berg | 2448798 | 2009-04-23 18:52:52 +0200 | [diff] [blame] | 29 | #include "driver-ops.h" |
Johannes Berg | 2c8dccc | 2008-04-08 15:14:40 -0400 | [diff] [blame] | 30 | #include "rate.h" |
| 31 | #include "led.h" |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 32 | |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 33 | #define IEEE80211_AUTH_TIMEOUT (HZ / 5) |
Johannes Berg | cb236d2 | 2013-07-29 23:07:43 +0200 | [diff] [blame] | 34 | #define IEEE80211_AUTH_TIMEOUT_LONG (HZ / 2) |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 35 | #define IEEE80211_AUTH_TIMEOUT_SHORT (HZ / 10) |
| 36 | #define IEEE80211_AUTH_MAX_TRIES 3 |
| 37 | #define IEEE80211_AUTH_WAIT_ASSOC (HZ * 5) |
| 38 | #define IEEE80211_ASSOC_TIMEOUT (HZ / 5) |
Johannes Berg | cb236d2 | 2013-07-29 23:07:43 +0200 | [diff] [blame] | 39 | #define IEEE80211_ASSOC_TIMEOUT_LONG (HZ / 2) |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 40 | #define IEEE80211_ASSOC_TIMEOUT_SHORT (HZ / 10) |
| 41 | #define IEEE80211_ASSOC_MAX_TRIES 3 |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 42 | |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 43 | static int max_nullfunc_tries = 2; |
| 44 | module_param(max_nullfunc_tries, int, 0644); |
| 45 | MODULE_PARM_DESC(max_nullfunc_tries, |
| 46 | "Maximum nullfunc tx tries before disconnecting (reason 4)."); |
| 47 | |
| 48 | static int max_probe_tries = 5; |
| 49 | module_param(max_probe_tries, int, 0644); |
| 50 | MODULE_PARM_DESC(max_probe_tries, |
| 51 | "Maximum probe tries before disconnecting (reason 4)."); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 52 | |
| 53 | /* |
Felix Fietkau | 7ccc8bd | 2010-11-19 22:55:38 +0100 | [diff] [blame] | 54 | * Beacon loss timeout is calculated as N frames times the |
| 55 | * advertised beacon interval. This may need to be somewhat |
| 56 | * higher than what hardware might detect to account for |
| 57 | * delays in the host processing frames. But since we also |
| 58 | * probe on beacon miss before declaring the connection lost |
| 59 | * default to what we want. |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 60 | */ |
Ben Greear | 59c1ec2 | 2013-03-19 14:19:56 -0700 | [diff] [blame] | 61 | static int beacon_loss_count = 7; |
| 62 | module_param(beacon_loss_count, int, 0644); |
| 63 | MODULE_PARM_DESC(beacon_loss_count, |
| 64 | "Number of beacon intervals before we decide beacon was lost."); |
Felix Fietkau | 7ccc8bd | 2010-11-19 22:55:38 +0100 | [diff] [blame] | 65 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 66 | /* |
| 67 | * Time the connection can be idle before we probe |
| 68 | * it to see if we can still talk to the AP. |
| 69 | */ |
Maxim Levitsky | d1c5091 | 2009-07-31 18:54:23 +0300 | [diff] [blame] | 70 | #define IEEE80211_CONNECTION_IDLE_TIME (30 * HZ) |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 71 | /* |
| 72 | * Time we wait for a probe response after sending |
| 73 | * a probe request because of beacon loss or for |
| 74 | * checking the connection still works. |
| 75 | */ |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 76 | static int probe_wait_ms = 500; |
| 77 | module_param(probe_wait_ms, int, 0644); |
| 78 | MODULE_PARM_DESC(probe_wait_ms, |
| 79 | "Maximum time(ms) to wait for probe response" |
| 80 | " before disconnecting (reason 4)."); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 81 | |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 82 | /* |
| 83 | * Weight given to the latest Beacon frame when calculating average signal |
| 84 | * strength for Beacon frames received in the current BSS. This must be |
| 85 | * between 1 and 15. |
| 86 | */ |
| 87 | #define IEEE80211_SIGNAL_AVE_WEIGHT 3 |
| 88 | |
Jouni Malinen | 391a200 | 2010-08-27 22:22:00 +0300 | [diff] [blame] | 89 | /* |
| 90 | * How many Beacon frames need to have been used in average signal strength |
| 91 | * before starting to indicate signal change events. |
| 92 | */ |
| 93 | #define IEEE80211_SIGNAL_AVE_MIN_COUNT 4 |
| 94 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 95 | /* |
Johannes Berg | ca386f3 | 2009-07-10 02:39:48 +0200 | [diff] [blame] | 96 | * We can have multiple work items (and connection probing) |
| 97 | * scheduling this timer, but we need to take care to only |
| 98 | * reschedule it when it should fire _earlier_ than it was |
| 99 | * asked for before, or if it's not pending right now. This |
| 100 | * function ensures that. Note that it then is required to |
| 101 | * run this function for all timeouts after the first one |
| 102 | * has happened -- the work that runs from this timer will |
| 103 | * do that. |
| 104 | */ |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 105 | static void run_again(struct ieee80211_sub_if_data *sdata, |
| 106 | unsigned long timeout) |
Johannes Berg | ca386f3 | 2009-07-10 02:39:48 +0200 | [diff] [blame] | 107 | { |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 108 | sdata_assert_lock(sdata); |
Johannes Berg | ca386f3 | 2009-07-10 02:39:48 +0200 | [diff] [blame] | 109 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 110 | if (!timer_pending(&sdata->u.mgd.timer) || |
| 111 | time_before(timeout, sdata->u.mgd.timer.expires)) |
| 112 | mod_timer(&sdata->u.mgd.timer, timeout); |
Johannes Berg | ca386f3 | 2009-07-10 02:39:48 +0200 | [diff] [blame] | 113 | } |
| 114 | |
Luis R. Rodriguez | d3a910a | 2010-09-16 15:12:32 -0400 | [diff] [blame] | 115 | void ieee80211_sta_reset_beacon_monitor(struct ieee80211_sub_if_data *sdata) |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 116 | { |
Johannes Berg | c1288b1 | 2012-01-19 09:29:57 +0100 | [diff] [blame] | 117 | if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER) |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 118 | return; |
| 119 | |
Johannes Berg | 7eeff74 | 2012-07-18 10:27:27 +0200 | [diff] [blame] | 120 | if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR) |
| 121 | return; |
| 122 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 123 | mod_timer(&sdata->u.mgd.bcn_mon_timer, |
Felix Fietkau | 7ccc8bd | 2010-11-19 22:55:38 +0100 | [diff] [blame] | 124 | round_jiffies_up(jiffies + sdata->u.mgd.beacon_timeout)); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 125 | } |
| 126 | |
Luis R. Rodriguez | be099e8 | 2010-09-16 15:12:29 -0400 | [diff] [blame] | 127 | void ieee80211_sta_reset_conn_monitor(struct ieee80211_sub_if_data *sdata) |
| 128 | { |
Luis R. Rodriguez | 0c699c3 | 2010-09-16 15:12:30 -0400 | [diff] [blame] | 129 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 130 | |
Stanislaw Gruszka | 8628172 | 2011-02-25 14:46:02 +0100 | [diff] [blame] | 131 | if (unlikely(!sdata->u.mgd.associated)) |
| 132 | return; |
| 133 | |
Eliad Peller | 448cd2e | 2014-02-11 12:30:18 +0200 | [diff] [blame] | 134 | ifmgd->probe_send_count = 0; |
| 135 | |
Luis R. Rodriguez | be099e8 | 2010-09-16 15:12:29 -0400 | [diff] [blame] | 136 | if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR) |
| 137 | return; |
| 138 | |
| 139 | mod_timer(&sdata->u.mgd.conn_mon_timer, |
| 140 | round_jiffies_up(jiffies + IEEE80211_CONNECTION_IDLE_TIME)); |
| 141 | } |
| 142 | |
Johannes Berg | 5484e23 | 2008-09-08 17:44:27 +0200 | [diff] [blame] | 143 | static int ecw2cw(int ecw) |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 144 | { |
Johannes Berg | 5484e23 | 2008-09-08 17:44:27 +0200 | [diff] [blame] | 145 | return (1 << ecw) - 1; |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 146 | } |
| 147 | |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 148 | static u32 |
| 149 | ieee80211_determine_chantype(struct ieee80211_sub_if_data *sdata, |
| 150 | struct ieee80211_supported_band *sband, |
| 151 | struct ieee80211_channel *channel, |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 152 | const struct ieee80211_ht_cap *ht_cap, |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 153 | const struct ieee80211_ht_operation *ht_oper, |
| 154 | const struct ieee80211_vht_operation *vht_oper, |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 155 | struct cfg80211_chan_def *chandef, bool tracking) |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 156 | { |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 157 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 158 | struct cfg80211_chan_def vht_chandef; |
| 159 | u32 ht_cfreq, ret; |
| 160 | |
| 161 | chandef->chan = channel; |
| 162 | chandef->width = NL80211_CHAN_WIDTH_20_NOHT; |
| 163 | chandef->center_freq1 = channel->center_freq; |
| 164 | chandef->center_freq2 = 0; |
| 165 | |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 166 | if (!ht_cap || !ht_oper || !sband->ht_cap.ht_supported) { |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 167 | ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT; |
| 168 | goto out; |
| 169 | } |
| 170 | |
| 171 | chandef->width = NL80211_CHAN_WIDTH_20; |
| 172 | |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 173 | if (!(ht_cap->cap_info & |
| 174 | cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH_20_40))) { |
| 175 | ret = IEEE80211_STA_DISABLE_40MHZ | IEEE80211_STA_DISABLE_VHT; |
| 176 | goto out; |
| 177 | } |
| 178 | |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 179 | ht_cfreq = ieee80211_channel_to_frequency(ht_oper->primary_chan, |
| 180 | channel->band); |
| 181 | /* check that channel matches the right operating channel */ |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 182 | if (!tracking && channel->center_freq != ht_cfreq) { |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 183 | /* |
| 184 | * It's possible that some APs are confused here; |
| 185 | * Netgear WNDR3700 sometimes reports 4 higher than |
| 186 | * the actual channel in association responses, but |
| 187 | * since we look at probe response/beacon data here |
| 188 | * it should be OK. |
| 189 | */ |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 190 | sdata_info(sdata, |
| 191 | "Wrong control channel: center-freq: %d ht-cfreq: %d ht->primary_chan: %d band: %d - Disabling HT\n", |
| 192 | channel->center_freq, ht_cfreq, |
| 193 | ht_oper->primary_chan, channel->band); |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 194 | ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT; |
| 195 | goto out; |
| 196 | } |
| 197 | |
| 198 | /* check 40 MHz support, if we have it */ |
| 199 | if (sband->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) { |
| 200 | switch (ht_oper->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) { |
| 201 | case IEEE80211_HT_PARAM_CHA_SEC_ABOVE: |
| 202 | chandef->width = NL80211_CHAN_WIDTH_40; |
| 203 | chandef->center_freq1 += 10; |
| 204 | break; |
| 205 | case IEEE80211_HT_PARAM_CHA_SEC_BELOW: |
| 206 | chandef->width = NL80211_CHAN_WIDTH_40; |
| 207 | chandef->center_freq1 -= 10; |
| 208 | break; |
| 209 | } |
| 210 | } else { |
| 211 | /* 40 MHz (and 80 MHz) must be supported for VHT */ |
| 212 | ret = IEEE80211_STA_DISABLE_VHT; |
Johannes Berg | 85220d7 | 2013-03-25 18:29:27 +0100 | [diff] [blame] | 213 | /* also mark 40 MHz disabled */ |
| 214 | ret |= IEEE80211_STA_DISABLE_40MHZ; |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 215 | goto out; |
| 216 | } |
| 217 | |
| 218 | if (!vht_oper || !sband->vht_cap.vht_supported) { |
| 219 | ret = IEEE80211_STA_DISABLE_VHT; |
| 220 | goto out; |
| 221 | } |
| 222 | |
| 223 | vht_chandef.chan = channel; |
| 224 | vht_chandef.center_freq1 = |
| 225 | ieee80211_channel_to_frequency(vht_oper->center_freq_seg1_idx, |
| 226 | channel->band); |
| 227 | vht_chandef.center_freq2 = 0; |
| 228 | |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 229 | switch (vht_oper->chan_width) { |
| 230 | case IEEE80211_VHT_CHANWIDTH_USE_HT: |
| 231 | vht_chandef.width = chandef->width; |
Johannes Berg | cb66498 | 2014-02-27 20:47:53 +0100 | [diff] [blame] | 232 | vht_chandef.center_freq1 = chandef->center_freq1; |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 233 | break; |
| 234 | case IEEE80211_VHT_CHANWIDTH_80MHZ: |
| 235 | vht_chandef.width = NL80211_CHAN_WIDTH_80; |
| 236 | break; |
| 237 | case IEEE80211_VHT_CHANWIDTH_160MHZ: |
| 238 | vht_chandef.width = NL80211_CHAN_WIDTH_160; |
| 239 | break; |
| 240 | case IEEE80211_VHT_CHANWIDTH_80P80MHZ: |
| 241 | vht_chandef.width = NL80211_CHAN_WIDTH_80P80; |
Johannes Berg | 6553bf04 | 2013-03-28 10:26:17 +0100 | [diff] [blame] | 242 | vht_chandef.center_freq2 = |
| 243 | ieee80211_channel_to_frequency( |
| 244 | vht_oper->center_freq_seg2_idx, |
| 245 | channel->band); |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 246 | break; |
| 247 | default: |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 248 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 249 | sdata_info(sdata, |
| 250 | "AP VHT operation IE has invalid channel width (%d), disable VHT\n", |
| 251 | vht_oper->chan_width); |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 252 | ret = IEEE80211_STA_DISABLE_VHT; |
| 253 | goto out; |
| 254 | } |
| 255 | |
| 256 | if (!cfg80211_chandef_valid(&vht_chandef)) { |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 257 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 258 | sdata_info(sdata, |
| 259 | "AP VHT information is invalid, disable VHT\n"); |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 260 | ret = IEEE80211_STA_DISABLE_VHT; |
| 261 | goto out; |
| 262 | } |
| 263 | |
| 264 | if (cfg80211_chandef_identical(chandef, &vht_chandef)) { |
| 265 | ret = 0; |
| 266 | goto out; |
| 267 | } |
| 268 | |
| 269 | if (!cfg80211_chandef_compatible(chandef, &vht_chandef)) { |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 270 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 271 | sdata_info(sdata, |
| 272 | "AP VHT information doesn't match HT, disable VHT\n"); |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 273 | ret = IEEE80211_STA_DISABLE_VHT; |
| 274 | goto out; |
| 275 | } |
| 276 | |
| 277 | *chandef = vht_chandef; |
| 278 | |
| 279 | ret = 0; |
| 280 | |
| 281 | out: |
Johannes Berg | 963a1852 | 2014-02-21 20:34:34 +0100 | [diff] [blame] | 282 | /* |
| 283 | * When tracking the current AP, don't do any further checks if the |
| 284 | * new chandef is identical to the one we're currently using for the |
| 285 | * connection. This keeps us from playing ping-pong with regulatory, |
| 286 | * without it the following can happen (for example): |
| 287 | * - connect to an AP with 80 MHz, world regdom allows 80 MHz |
| 288 | * - AP advertises regdom US |
| 289 | * - CRDA loads regdom US with 80 MHz prohibited (old database) |
| 290 | * - the code below detects an unsupported channel, downgrades, and |
| 291 | * we disconnect from the AP in the caller |
| 292 | * - disconnect causes CRDA to reload world regdomain and the game |
| 293 | * starts anew. |
| 294 | * (see https://bugzilla.kernel.org/show_bug.cgi?id=70881) |
| 295 | * |
| 296 | * It seems possible that there are still scenarios with CSA or real |
| 297 | * bandwidth changes where a this could happen, but those cases are |
| 298 | * less common and wouldn't completely prevent using the AP. |
| 299 | */ |
| 300 | if (tracking && |
| 301 | cfg80211_chandef_identical(chandef, &sdata->vif.bss_conf.chandef)) |
| 302 | return ret; |
| 303 | |
Johannes Berg | 586e01e | 2013-02-14 12:13:53 +0100 | [diff] [blame] | 304 | /* don't print the message below for VHT mismatch if VHT is disabled */ |
| 305 | if (ret & IEEE80211_STA_DISABLE_VHT) |
| 306 | vht_chandef = *chandef; |
| 307 | |
Johannes Berg | ddfe49b | 2013-07-31 20:52:03 +0200 | [diff] [blame] | 308 | /* |
| 309 | * Ignore the DISABLED flag when we're already connected and only |
| 310 | * tracking the APs beacon for bandwidth changes - otherwise we |
| 311 | * might get disconnected here if we connect to an AP, update our |
| 312 | * regulatory information based on the AP's country IE and the |
| 313 | * information we have is wrong/outdated and disables the channel |
| 314 | * that we're actually using for the connection to the AP. |
| 315 | */ |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 316 | while (!cfg80211_chandef_usable(sdata->local->hw.wiphy, chandef, |
Johannes Berg | ddfe49b | 2013-07-31 20:52:03 +0200 | [diff] [blame] | 317 | tracking ? 0 : |
| 318 | IEEE80211_CHAN_DISABLED)) { |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 319 | if (WARN_ON(chandef->width == NL80211_CHAN_WIDTH_20_NOHT)) { |
| 320 | ret = IEEE80211_STA_DISABLE_HT | |
| 321 | IEEE80211_STA_DISABLE_VHT; |
Chris Wright | b56e4b8 | 2013-07-31 12:12:24 -0700 | [diff] [blame] | 322 | break; |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 323 | } |
| 324 | |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 325 | ret |= ieee80211_chandef_downgrade(chandef); |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 326 | } |
| 327 | |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 328 | if (chandef->width != vht_chandef.width && !tracking) |
Johannes Berg | 6565ec9 | 2013-02-08 14:52:32 +0100 | [diff] [blame] | 329 | sdata_info(sdata, |
| 330 | "capabilities/regulatory prevented using AP HT/VHT configuration, downgraded\n"); |
| 331 | |
| 332 | WARN_ON_ONCE(!cfg80211_chandef_valid(chandef)); |
| 333 | return ret; |
| 334 | } |
| 335 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 336 | static int ieee80211_config_bw(struct ieee80211_sub_if_data *sdata, |
| 337 | struct sta_info *sta, |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 338 | const struct ieee80211_ht_cap *ht_cap, |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 339 | const struct ieee80211_ht_operation *ht_oper, |
| 340 | const struct ieee80211_vht_operation *vht_oper, |
| 341 | const u8 *bssid, u32 *changed) |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 342 | { |
| 343 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 344 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 345 | struct ieee80211_supported_band *sband; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 346 | struct ieee80211_channel *chan; |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 347 | struct cfg80211_chan_def chandef; |
Johannes Berg | 9ed6bcc | 2009-05-08 20:47:39 +0200 | [diff] [blame] | 348 | u16 ht_opmode; |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 349 | u32 flags; |
| 350 | enum ieee80211_sta_rx_bandwidth new_sta_bw; |
| 351 | int ret; |
| 352 | |
| 353 | /* if HT was/is disabled, don't track any bandwidth changes */ |
| 354 | if (ifmgd->flags & IEEE80211_STA_DISABLE_HT || !ht_oper) |
| 355 | return 0; |
| 356 | |
| 357 | /* don't check VHT if we associated as non-VHT station */ |
| 358 | if (ifmgd->flags & IEEE80211_STA_DISABLE_VHT) |
| 359 | vht_oper = NULL; |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 360 | |
Johannes Berg | 1128958 | 2013-02-07 17:36:12 +0100 | [diff] [blame] | 361 | if (WARN_ON_ONCE(!sta)) |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 362 | return -EINVAL; |
Johannes Berg | 1128958 | 2013-02-07 17:36:12 +0100 | [diff] [blame] | 363 | |
Avri Altman | 017b45b | 2013-11-18 19:06:48 +0200 | [diff] [blame] | 364 | /* |
| 365 | * if bss configuration changed store the new one - |
| 366 | * this may be applicable even if channel is identical |
| 367 | */ |
| 368 | ht_opmode = le16_to_cpu(ht_oper->operation_mode); |
| 369 | if (sdata->vif.bss_conf.ht_operation_mode != ht_opmode) { |
| 370 | *changed |= BSS_CHANGED_HT; |
| 371 | sdata->vif.bss_conf.ht_operation_mode = ht_opmode; |
| 372 | } |
| 373 | |
Johannes Berg | f2d9330 | 2013-02-08 13:15:55 +0100 | [diff] [blame] | 374 | chan = sdata->vif.bss_conf.chandef.chan; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 375 | sband = local->hw.wiphy->bands[chan->band]; |
Johannes Berg | 0aaffa9 | 2010-05-05 15:28:27 +0200 | [diff] [blame] | 376 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 377 | /* calculate new channel (type) based on HT/VHT operation IEs */ |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 378 | flags = ieee80211_determine_chantype(sdata, sband, chan, |
| 379 | ht_cap, ht_oper, vht_oper, |
| 380 | &chandef, true); |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 381 | |
| 382 | /* |
| 383 | * Downgrade the new channel if we associated with restricted |
| 384 | * capabilities. For example, if we associated as a 20 MHz STA |
| 385 | * to a 40 MHz AP (due to regulatory, capabilities or config |
| 386 | * reasons) then switching to a 40 MHz channel now won't do us |
| 387 | * any good -- we couldn't use it with the AP. |
| 388 | */ |
| 389 | if (ifmgd->flags & IEEE80211_STA_DISABLE_80P80MHZ && |
| 390 | chandef.width == NL80211_CHAN_WIDTH_80P80) |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 391 | flags |= ieee80211_chandef_downgrade(&chandef); |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 392 | if (ifmgd->flags & IEEE80211_STA_DISABLE_160MHZ && |
| 393 | chandef.width == NL80211_CHAN_WIDTH_160) |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 394 | flags |= ieee80211_chandef_downgrade(&chandef); |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 395 | if (ifmgd->flags & IEEE80211_STA_DISABLE_40MHZ && |
| 396 | chandef.width > NL80211_CHAN_WIDTH_20) |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 397 | flags |= ieee80211_chandef_downgrade(&chandef); |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 398 | |
| 399 | if (cfg80211_chandef_identical(&chandef, &sdata->vif.bss_conf.chandef)) |
| 400 | return 0; |
| 401 | |
| 402 | sdata_info(sdata, |
| 403 | "AP %pM changed bandwidth, new config is %d MHz, width %d (%d/%d MHz)\n", |
| 404 | ifmgd->bssid, chandef.chan->center_freq, chandef.width, |
| 405 | chandef.center_freq1, chandef.center_freq2); |
| 406 | |
| 407 | if (flags != (ifmgd->flags & (IEEE80211_STA_DISABLE_HT | |
| 408 | IEEE80211_STA_DISABLE_VHT | |
| 409 | IEEE80211_STA_DISABLE_40MHZ | |
| 410 | IEEE80211_STA_DISABLE_80P80MHZ | |
| 411 | IEEE80211_STA_DISABLE_160MHZ)) || |
| 412 | !cfg80211_chandef_valid(&chandef)) { |
| 413 | sdata_info(sdata, |
| 414 | "AP %pM changed bandwidth in a way we can't support - disconnect\n", |
| 415 | ifmgd->bssid); |
| 416 | return -EINVAL; |
Johannes Berg | 64f68e5 | 2012-03-28 10:58:37 +0200 | [diff] [blame] | 417 | } |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 418 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 419 | switch (chandef.width) { |
| 420 | case NL80211_CHAN_WIDTH_20_NOHT: |
| 421 | case NL80211_CHAN_WIDTH_20: |
| 422 | new_sta_bw = IEEE80211_STA_RX_BW_20; |
| 423 | break; |
| 424 | case NL80211_CHAN_WIDTH_40: |
| 425 | new_sta_bw = IEEE80211_STA_RX_BW_40; |
| 426 | break; |
| 427 | case NL80211_CHAN_WIDTH_80: |
| 428 | new_sta_bw = IEEE80211_STA_RX_BW_80; |
| 429 | break; |
| 430 | case NL80211_CHAN_WIDTH_80P80: |
| 431 | case NL80211_CHAN_WIDTH_160: |
| 432 | new_sta_bw = IEEE80211_STA_RX_BW_160; |
| 433 | break; |
| 434 | default: |
| 435 | return -EINVAL; |
| 436 | } |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 437 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 438 | if (new_sta_bw > sta->cur_max_bandwidth) |
| 439 | new_sta_bw = sta->cur_max_bandwidth; |
Johannes Berg | 64f68e5 | 2012-03-28 10:58:37 +0200 | [diff] [blame] | 440 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 441 | if (new_sta_bw < sta->sta.bandwidth) { |
| 442 | sta->sta.bandwidth = new_sta_bw; |
| 443 | rate_control_rate_update(local, sband, sta, |
| 444 | IEEE80211_RC_BW_CHANGED); |
| 445 | } |
Rajkumar Manoharan | 7cc44ed | 2011-09-16 15:32:34 +0530 | [diff] [blame] | 446 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 447 | ret = ieee80211_vif_change_bandwidth(sdata, &chandef, changed); |
| 448 | if (ret) { |
| 449 | sdata_info(sdata, |
| 450 | "AP %pM changed bandwidth to incompatible one - disconnect\n", |
| 451 | ifmgd->bssid); |
| 452 | return ret; |
| 453 | } |
| 454 | |
| 455 | if (new_sta_bw > sta->sta.bandwidth) { |
| 456 | sta->sta.bandwidth = new_sta_bw; |
| 457 | rate_control_rate_update(local, sband, sta, |
| 458 | IEEE80211_RC_BW_CHANGED); |
Johannes Berg | 0aaffa9 | 2010-05-05 15:28:27 +0200 | [diff] [blame] | 459 | } |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 460 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 461 | return 0; |
Johannes Berg | d5522e0 | 2009-03-30 13:23:35 +0200 | [diff] [blame] | 462 | } |
| 463 | |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 464 | /* frame sending functions */ |
| 465 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 466 | static void ieee80211_add_ht_ie(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 9dde642 | 2012-05-16 23:43:19 +0200 | [diff] [blame] | 467 | struct sk_buff *skb, u8 ap_ht_param, |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 468 | struct ieee80211_supported_band *sband, |
| 469 | struct ieee80211_channel *channel, |
| 470 | enum ieee80211_smps_mode smps) |
| 471 | { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 472 | u8 *pos; |
| 473 | u32 flags = channel->flags; |
| 474 | u16 cap; |
| 475 | struct ieee80211_sta_ht_cap ht_cap; |
| 476 | |
| 477 | BUILD_BUG_ON(sizeof(ht_cap) != sizeof(sband->ht_cap)); |
| 478 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 479 | memcpy(&ht_cap, &sband->ht_cap, sizeof(ht_cap)); |
| 480 | ieee80211_apply_htcap_overrides(sdata, &ht_cap); |
| 481 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 482 | /* determine capability flags */ |
| 483 | cap = ht_cap.cap; |
| 484 | |
Johannes Berg | 9dde642 | 2012-05-16 23:43:19 +0200 | [diff] [blame] | 485 | switch (ap_ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 486 | case IEEE80211_HT_PARAM_CHA_SEC_ABOVE: |
| 487 | if (flags & IEEE80211_CHAN_NO_HT40PLUS) { |
| 488 | cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40; |
| 489 | cap &= ~IEEE80211_HT_CAP_SGI_40; |
| 490 | } |
| 491 | break; |
| 492 | case IEEE80211_HT_PARAM_CHA_SEC_BELOW: |
| 493 | if (flags & IEEE80211_CHAN_NO_HT40MINUS) { |
| 494 | cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40; |
| 495 | cap &= ~IEEE80211_HT_CAP_SGI_40; |
| 496 | } |
| 497 | break; |
| 498 | } |
| 499 | |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 500 | /* |
| 501 | * If 40 MHz was disabled associate as though we weren't |
| 502 | * capable of 40 MHz -- some broken APs will never fall |
| 503 | * back to trying to transmit in 20 MHz. |
| 504 | */ |
| 505 | if (sdata->u.mgd.flags & IEEE80211_STA_DISABLE_40MHZ) { |
| 506 | cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40; |
| 507 | cap &= ~IEEE80211_HT_CAP_SGI_40; |
| 508 | } |
| 509 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 510 | /* set SM PS mode properly */ |
| 511 | cap &= ~IEEE80211_HT_CAP_SM_PS; |
| 512 | switch (smps) { |
| 513 | case IEEE80211_SMPS_AUTOMATIC: |
| 514 | case IEEE80211_SMPS_NUM_MODES: |
| 515 | WARN_ON(1); |
| 516 | case IEEE80211_SMPS_OFF: |
| 517 | cap |= WLAN_HT_CAP_SM_PS_DISABLED << |
| 518 | IEEE80211_HT_CAP_SM_PS_SHIFT; |
| 519 | break; |
| 520 | case IEEE80211_SMPS_STATIC: |
| 521 | cap |= WLAN_HT_CAP_SM_PS_STATIC << |
| 522 | IEEE80211_HT_CAP_SM_PS_SHIFT; |
| 523 | break; |
| 524 | case IEEE80211_SMPS_DYNAMIC: |
| 525 | cap |= WLAN_HT_CAP_SM_PS_DYNAMIC << |
| 526 | IEEE80211_HT_CAP_SM_PS_SHIFT; |
| 527 | break; |
| 528 | } |
| 529 | |
| 530 | /* reserve and fill IE */ |
| 531 | pos = skb_put(skb, sizeof(struct ieee80211_ht_cap) + 2); |
| 532 | ieee80211_ie_build_ht_cap(pos, &ht_cap, cap); |
| 533 | } |
| 534 | |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 535 | static void ieee80211_add_vht_ie(struct ieee80211_sub_if_data *sdata, |
| 536 | struct sk_buff *skb, |
Johannes Berg | b08fbbd | 2012-12-07 13:06:48 +0100 | [diff] [blame] | 537 | struct ieee80211_supported_band *sband, |
| 538 | struct ieee80211_vht_cap *ap_vht_cap) |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 539 | { |
| 540 | u8 *pos; |
| 541 | u32 cap; |
| 542 | struct ieee80211_sta_vht_cap vht_cap; |
Eyal Shapira | c1cf6d4 | 2014-01-08 15:49:08 +0200 | [diff] [blame] | 543 | u32 mask, ap_bf_sts, our_bf_sts; |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 544 | |
| 545 | BUILD_BUG_ON(sizeof(vht_cap) != sizeof(sband->vht_cap)); |
| 546 | |
| 547 | memcpy(&vht_cap, &sband->vht_cap, sizeof(vht_cap)); |
Johannes Berg | dd5ecfe | 2013-02-21 17:40:19 +0100 | [diff] [blame] | 548 | ieee80211_apply_vhtcap_overrides(sdata, &vht_cap); |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 549 | |
| 550 | /* determine capability flags */ |
| 551 | cap = vht_cap.cap; |
| 552 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 553 | if (sdata->u.mgd.flags & IEEE80211_STA_DISABLE_80P80MHZ) { |
| 554 | cap &= ~IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160_80PLUS80MHZ; |
| 555 | cap |= IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ; |
| 556 | } |
| 557 | |
| 558 | if (sdata->u.mgd.flags & IEEE80211_STA_DISABLE_160MHZ) { |
| 559 | cap &= ~IEEE80211_VHT_CAP_SHORT_GI_160; |
| 560 | cap &= ~IEEE80211_VHT_CAP_SUPP_CHAN_WIDTH_160MHZ; |
| 561 | } |
| 562 | |
Johannes Berg | b08fbbd | 2012-12-07 13:06:48 +0100 | [diff] [blame] | 563 | /* |
| 564 | * Some APs apparently get confused if our capabilities are better |
| 565 | * than theirs, so restrict what we advertise in the assoc request. |
| 566 | */ |
| 567 | if (!(ap_vht_cap->vht_cap_info & |
| 568 | cpu_to_le32(IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE))) |
| 569 | cap &= ~IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE; |
| 570 | |
Eyal Shapira | c1cf6d4 | 2014-01-08 15:49:08 +0200 | [diff] [blame] | 571 | mask = IEEE80211_VHT_CAP_BEAMFORMEE_STS_MASK; |
| 572 | |
| 573 | ap_bf_sts = le32_to_cpu(ap_vht_cap->vht_cap_info) & mask; |
| 574 | our_bf_sts = cap & mask; |
| 575 | |
| 576 | if (ap_bf_sts < our_bf_sts) { |
| 577 | cap &= ~mask; |
| 578 | cap |= ap_bf_sts; |
| 579 | } |
| 580 | |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 581 | /* reserve and fill IE */ |
Mahesh Palivela | d495028 | 2012-10-10 11:25:40 +0000 | [diff] [blame] | 582 | pos = skb_put(skb, sizeof(struct ieee80211_vht_cap) + 2); |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 583 | ieee80211_ie_build_vht_cap(pos, &vht_cap, cap); |
| 584 | } |
| 585 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 586 | static void ieee80211_send_assoc(struct ieee80211_sub_if_data *sdata) |
| 587 | { |
| 588 | struct ieee80211_local *local = sdata->local; |
| 589 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 590 | struct ieee80211_mgd_assoc_data *assoc_data = ifmgd->assoc_data; |
| 591 | struct sk_buff *skb; |
| 592 | struct ieee80211_mgmt *mgmt; |
| 593 | u8 *pos, qos_info; |
| 594 | size_t offset = 0, noffset; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 595 | int i, count, rates_len, supp_rates_len, shift; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 596 | u16 capab; |
| 597 | struct ieee80211_supported_band *sband; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 598 | struct ieee80211_chanctx_conf *chanctx_conf; |
| 599 | struct ieee80211_channel *chan; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 600 | u32 rate_flags, rates = 0; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 601 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 602 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 603 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 604 | rcu_read_lock(); |
| 605 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 606 | if (WARN_ON(!chanctx_conf)) { |
| 607 | rcu_read_unlock(); |
| 608 | return; |
| 609 | } |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 610 | chan = chanctx_conf->def.chan; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 611 | rate_flags = ieee80211_chandef_rate_flags(&chanctx_conf->def); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 612 | rcu_read_unlock(); |
| 613 | sband = local->hw.wiphy->bands[chan->band]; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 614 | shift = ieee80211_vif_get_shift(&sdata->vif); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 615 | |
| 616 | if (assoc_data->supp_rates_len) { |
| 617 | /* |
| 618 | * Get all rates supported by the device and the AP as |
| 619 | * some APs don't like getting a superset of their rates |
| 620 | * in the association request (e.g. D-Link DAP 1353 in |
| 621 | * b-only mode)... |
| 622 | */ |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 623 | rates_len = ieee80211_parse_bitrates(&chanctx_conf->def, sband, |
| 624 | assoc_data->supp_rates, |
| 625 | assoc_data->supp_rates_len, |
| 626 | &rates); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 627 | } else { |
| 628 | /* |
| 629 | * In case AP not provide any supported rates information |
| 630 | * before association, we send information element(s) with |
| 631 | * all rates that we support. |
| 632 | */ |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 633 | rates_len = 0; |
| 634 | for (i = 0; i < sband->n_bitrates; i++) { |
| 635 | if ((rate_flags & sband->bitrates[i].flags) |
| 636 | != rate_flags) |
| 637 | continue; |
| 638 | rates |= BIT(i); |
| 639 | rates_len++; |
| 640 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 641 | } |
| 642 | |
| 643 | skb = alloc_skb(local->hw.extra_tx_headroom + |
| 644 | sizeof(*mgmt) + /* bit too much but doesn't matter */ |
| 645 | 2 + assoc_data->ssid_len + /* SSID */ |
| 646 | 4 + rates_len + /* (extended) rates */ |
| 647 | 4 + /* power capability */ |
| 648 | 2 + 2 * sband->n_channels + /* supported channels */ |
| 649 | 2 + sizeof(struct ieee80211_ht_cap) + /* HT */ |
Mahesh Palivela | d495028 | 2012-10-10 11:25:40 +0000 | [diff] [blame] | 650 | 2 + sizeof(struct ieee80211_vht_cap) + /* VHT */ |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 651 | assoc_data->ie_len + /* extra IEs */ |
| 652 | 9, /* WMM */ |
| 653 | GFP_KERNEL); |
| 654 | if (!skb) |
| 655 | return; |
| 656 | |
| 657 | skb_reserve(skb, local->hw.extra_tx_headroom); |
| 658 | |
| 659 | capab = WLAN_CAPABILITY_ESS; |
| 660 | |
| 661 | if (sband->band == IEEE80211_BAND_2GHZ) { |
| 662 | if (!(local->hw.flags & IEEE80211_HW_2GHZ_SHORT_SLOT_INCAPABLE)) |
| 663 | capab |= WLAN_CAPABILITY_SHORT_SLOT_TIME; |
| 664 | if (!(local->hw.flags & IEEE80211_HW_2GHZ_SHORT_PREAMBLE_INCAPABLE)) |
| 665 | capab |= WLAN_CAPABILITY_SHORT_PREAMBLE; |
| 666 | } |
| 667 | |
| 668 | if (assoc_data->capability & WLAN_CAPABILITY_PRIVACY) |
| 669 | capab |= WLAN_CAPABILITY_PRIVACY; |
| 670 | |
| 671 | if ((assoc_data->capability & WLAN_CAPABILITY_SPECTRUM_MGMT) && |
| 672 | (local->hw.flags & IEEE80211_HW_SPECTRUM_MGMT)) |
| 673 | capab |= WLAN_CAPABILITY_SPECTRUM_MGMT; |
| 674 | |
| 675 | mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24); |
| 676 | memset(mgmt, 0, 24); |
| 677 | memcpy(mgmt->da, assoc_data->bss->bssid, ETH_ALEN); |
| 678 | memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN); |
| 679 | memcpy(mgmt->bssid, assoc_data->bss->bssid, ETH_ALEN); |
| 680 | |
| 681 | if (!is_zero_ether_addr(assoc_data->prev_bssid)) { |
| 682 | skb_put(skb, 10); |
| 683 | mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | |
| 684 | IEEE80211_STYPE_REASSOC_REQ); |
| 685 | mgmt->u.reassoc_req.capab_info = cpu_to_le16(capab); |
| 686 | mgmt->u.reassoc_req.listen_interval = |
| 687 | cpu_to_le16(local->hw.conf.listen_interval); |
| 688 | memcpy(mgmt->u.reassoc_req.current_ap, assoc_data->prev_bssid, |
| 689 | ETH_ALEN); |
| 690 | } else { |
| 691 | skb_put(skb, 4); |
| 692 | mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | |
| 693 | IEEE80211_STYPE_ASSOC_REQ); |
| 694 | mgmt->u.assoc_req.capab_info = cpu_to_le16(capab); |
| 695 | mgmt->u.assoc_req.listen_interval = |
| 696 | cpu_to_le16(local->hw.conf.listen_interval); |
| 697 | } |
| 698 | |
| 699 | /* SSID */ |
| 700 | pos = skb_put(skb, 2 + assoc_data->ssid_len); |
| 701 | *pos++ = WLAN_EID_SSID; |
| 702 | *pos++ = assoc_data->ssid_len; |
| 703 | memcpy(pos, assoc_data->ssid, assoc_data->ssid_len); |
| 704 | |
| 705 | /* add all rates which were marked to be used above */ |
| 706 | supp_rates_len = rates_len; |
| 707 | if (supp_rates_len > 8) |
| 708 | supp_rates_len = 8; |
| 709 | |
| 710 | pos = skb_put(skb, supp_rates_len + 2); |
| 711 | *pos++ = WLAN_EID_SUPP_RATES; |
| 712 | *pos++ = supp_rates_len; |
| 713 | |
| 714 | count = 0; |
| 715 | for (i = 0; i < sband->n_bitrates; i++) { |
| 716 | if (BIT(i) & rates) { |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 717 | int rate = DIV_ROUND_UP(sband->bitrates[i].bitrate, |
| 718 | 5 * (1 << shift)); |
| 719 | *pos++ = (u8) rate; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 720 | if (++count == 8) |
| 721 | break; |
| 722 | } |
| 723 | } |
| 724 | |
| 725 | if (rates_len > count) { |
| 726 | pos = skb_put(skb, rates_len - count + 2); |
| 727 | *pos++ = WLAN_EID_EXT_SUPP_RATES; |
| 728 | *pos++ = rates_len - count; |
| 729 | |
| 730 | for (i++; i < sband->n_bitrates; i++) { |
| 731 | if (BIT(i) & rates) { |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 732 | int rate; |
| 733 | rate = DIV_ROUND_UP(sband->bitrates[i].bitrate, |
| 734 | 5 * (1 << shift)); |
| 735 | *pos++ = (u8) rate; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 736 | } |
| 737 | } |
| 738 | } |
| 739 | |
| 740 | if (capab & WLAN_CAPABILITY_SPECTRUM_MGMT) { |
| 741 | /* 1. power capabilities */ |
| 742 | pos = skb_put(skb, 4); |
| 743 | *pos++ = WLAN_EID_PWR_CAPABILITY; |
| 744 | *pos++ = 2; |
| 745 | *pos++ = 0; /* min tx power */ |
Simon Wunderlich | 0430c88 | 2013-07-08 16:55:55 +0200 | [diff] [blame] | 746 | /* max tx power */ |
| 747 | *pos++ = ieee80211_chandef_max_power(&chanctx_conf->def); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 748 | |
| 749 | /* 2. supported channels */ |
| 750 | /* TODO: get this in reg domain format */ |
| 751 | pos = skb_put(skb, 2 * sband->n_channels + 2); |
| 752 | *pos++ = WLAN_EID_SUPPORTED_CHANNELS; |
| 753 | *pos++ = 2 * sband->n_channels; |
| 754 | for (i = 0; i < sband->n_channels; i++) { |
| 755 | *pos++ = ieee80211_frequency_to_channel( |
| 756 | sband->channels[i].center_freq); |
| 757 | *pos++ = 1; /* one channel in the subband*/ |
| 758 | } |
| 759 | } |
| 760 | |
| 761 | /* if present, add any custom IEs that go before HT */ |
Johannes Berg | b3f51e9 | 2013-10-25 11:31:42 +0200 | [diff] [blame] | 762 | if (assoc_data->ie_len) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 763 | static const u8 before_ht[] = { |
| 764 | WLAN_EID_SSID, |
| 765 | WLAN_EID_SUPP_RATES, |
| 766 | WLAN_EID_EXT_SUPP_RATES, |
| 767 | WLAN_EID_PWR_CAPABILITY, |
| 768 | WLAN_EID_SUPPORTED_CHANNELS, |
| 769 | WLAN_EID_RSN, |
| 770 | WLAN_EID_QOS_CAPA, |
| 771 | WLAN_EID_RRM_ENABLED_CAPABILITIES, |
| 772 | WLAN_EID_MOBILITY_DOMAIN, |
| 773 | WLAN_EID_SUPPORTED_REGULATORY_CLASSES, |
| 774 | }; |
| 775 | noffset = ieee80211_ie_split(assoc_data->ie, assoc_data->ie_len, |
| 776 | before_ht, ARRAY_SIZE(before_ht), |
| 777 | offset); |
| 778 | pos = skb_put(skb, noffset - offset); |
| 779 | memcpy(pos, assoc_data->ie + offset, noffset - offset); |
| 780 | offset = noffset; |
| 781 | } |
| 782 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 783 | if (WARN_ON_ONCE((ifmgd->flags & IEEE80211_STA_DISABLE_HT) && |
| 784 | !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT))) |
| 785 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
| 786 | |
Johannes Berg | a8243b7 | 2012-11-22 14:32:09 +0100 | [diff] [blame] | 787 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) |
Johannes Berg | 9dde642 | 2012-05-16 23:43:19 +0200 | [diff] [blame] | 788 | ieee80211_add_ht_ie(sdata, skb, assoc_data->ap_ht_param, |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 789 | sband, chan, sdata->smps_mode); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 790 | |
Johannes Berg | 3de3802 | 2014-02-04 09:54:07 +0100 | [diff] [blame] | 791 | /* if present, add any custom IEs that go before VHT */ |
| 792 | if (assoc_data->ie_len) { |
| 793 | static const u8 before_vht[] = { |
| 794 | WLAN_EID_SSID, |
| 795 | WLAN_EID_SUPP_RATES, |
| 796 | WLAN_EID_EXT_SUPP_RATES, |
| 797 | WLAN_EID_PWR_CAPABILITY, |
| 798 | WLAN_EID_SUPPORTED_CHANNELS, |
| 799 | WLAN_EID_RSN, |
| 800 | WLAN_EID_QOS_CAPA, |
| 801 | WLAN_EID_RRM_ENABLED_CAPABILITIES, |
| 802 | WLAN_EID_MOBILITY_DOMAIN, |
| 803 | WLAN_EID_SUPPORTED_REGULATORY_CLASSES, |
| 804 | WLAN_EID_HT_CAPABILITY, |
| 805 | WLAN_EID_BSS_COEX_2040, |
| 806 | WLAN_EID_EXT_CAPABILITY, |
| 807 | WLAN_EID_QOS_TRAFFIC_CAPA, |
| 808 | WLAN_EID_TIM_BCAST_REQ, |
| 809 | WLAN_EID_INTERWORKING, |
| 810 | }; |
| 811 | noffset = ieee80211_ie_split(assoc_data->ie, assoc_data->ie_len, |
| 812 | before_vht, ARRAY_SIZE(before_vht), |
| 813 | offset); |
| 814 | pos = skb_put(skb, noffset - offset); |
| 815 | memcpy(pos, assoc_data->ie + offset, noffset - offset); |
| 816 | offset = noffset; |
| 817 | } |
| 818 | |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 819 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) |
Johannes Berg | b08fbbd | 2012-12-07 13:06:48 +0100 | [diff] [blame] | 820 | ieee80211_add_vht_ie(sdata, skb, sband, |
| 821 | &assoc_data->ap_vht_cap); |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 822 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 823 | /* if present, add any custom non-vendor IEs that go after HT */ |
Johannes Berg | b3f51e9 | 2013-10-25 11:31:42 +0200 | [diff] [blame] | 824 | if (assoc_data->ie_len) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 825 | noffset = ieee80211_ie_split_vendor(assoc_data->ie, |
| 826 | assoc_data->ie_len, |
| 827 | offset); |
| 828 | pos = skb_put(skb, noffset - offset); |
| 829 | memcpy(pos, assoc_data->ie + offset, noffset - offset); |
| 830 | offset = noffset; |
| 831 | } |
| 832 | |
Johannes Berg | 76f0303 | 2012-03-08 15:02:05 +0100 | [diff] [blame] | 833 | if (assoc_data->wmm) { |
| 834 | if (assoc_data->uapsd) { |
Eliad Peller | dc41e4d | 2012-03-14 16:15:03 +0200 | [diff] [blame] | 835 | qos_info = ifmgd->uapsd_queues; |
| 836 | qos_info |= (ifmgd->uapsd_max_sp_len << |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 837 | IEEE80211_WMM_IE_STA_QOSINFO_SP_SHIFT); |
| 838 | } else { |
| 839 | qos_info = 0; |
| 840 | } |
| 841 | |
Arik Nemtsov | 40b861a | 2014-07-17 17:14:23 +0300 | [diff] [blame] | 842 | pos = ieee80211_add_wmm_info_ie(skb_put(skb, 9), qos_info); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 843 | } |
| 844 | |
| 845 | /* add any remaining custom (i.e. vendor specific here) IEs */ |
Johannes Berg | b3f51e9 | 2013-10-25 11:31:42 +0200 | [diff] [blame] | 846 | if (assoc_data->ie_len) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 847 | noffset = assoc_data->ie_len; |
| 848 | pos = skb_put(skb, noffset - offset); |
| 849 | memcpy(pos, assoc_data->ie + offset, noffset - offset); |
| 850 | } |
| 851 | |
Johannes Berg | a1845fc | 2012-06-27 13:18:36 +0200 | [diff] [blame] | 852 | drv_mgd_prepare_tx(local, sdata); |
| 853 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 854 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 855 | if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) |
| 856 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS | |
| 857 | IEEE80211_TX_INTFL_MLME_CONN_TX; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 858 | ieee80211_tx_skb(sdata, skb); |
| 859 | } |
| 860 | |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 861 | void ieee80211_send_pspoll(struct ieee80211_local *local, |
| 862 | struct ieee80211_sub_if_data *sdata) |
| 863 | { |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 864 | struct ieee80211_pspoll *pspoll; |
| 865 | struct sk_buff *skb; |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 866 | |
Kalle Valo | d8cd189 | 2010-01-05 20:16:26 +0200 | [diff] [blame] | 867 | skb = ieee80211_pspoll_get(&local->hw, &sdata->vif); |
| 868 | if (!skb) |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 869 | return; |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 870 | |
Kalle Valo | d8cd189 | 2010-01-05 20:16:26 +0200 | [diff] [blame] | 871 | pspoll = (struct ieee80211_pspoll *) skb->data; |
| 872 | pspoll->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM); |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 873 | |
Johannes Berg | 62ae67b | 2009-11-18 18:42:05 +0100 | [diff] [blame] | 874 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; |
| 875 | ieee80211_tx_skb(sdata, skb); |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 876 | } |
| 877 | |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 878 | void ieee80211_send_nullfunc(struct ieee80211_local *local, |
| 879 | struct ieee80211_sub_if_data *sdata, |
| 880 | int powersave) |
| 881 | { |
| 882 | struct sk_buff *skb; |
Kalle Valo | d8cd189 | 2010-01-05 20:16:26 +0200 | [diff] [blame] | 883 | struct ieee80211_hdr_3addr *nullfunc; |
Rajkumar Manoharan | b6f3530 | 2011-09-29 20:34:04 +0530 | [diff] [blame] | 884 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 885 | |
Kalle Valo | d8cd189 | 2010-01-05 20:16:26 +0200 | [diff] [blame] | 886 | skb = ieee80211_nullfunc_get(&local->hw, &sdata->vif); |
| 887 | if (!skb) |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 888 | return; |
| 889 | |
Kalle Valo | d8cd189 | 2010-01-05 20:16:26 +0200 | [diff] [blame] | 890 | nullfunc = (struct ieee80211_hdr_3addr *) skb->data; |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 891 | if (powersave) |
Kalle Valo | d8cd189 | 2010-01-05 20:16:26 +0200 | [diff] [blame] | 892 | nullfunc->frame_control |= cpu_to_le16(IEEE80211_FCTL_PM); |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 893 | |
Seth Forshee | 6c17b77 | 2013-02-11 11:21:07 -0600 | [diff] [blame] | 894 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT | |
| 895 | IEEE80211_TX_INTFL_OFFCHAN_TX_OK; |
Pontus Fuchs | ff40b42 | 2013-06-04 12:44:52 +0200 | [diff] [blame] | 896 | |
| 897 | if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) |
| 898 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS; |
| 899 | |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 900 | if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL) |
Rajkumar Manoharan | b6f3530 | 2011-09-29 20:34:04 +0530 | [diff] [blame] | 901 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_CTL_USE_MINRATE; |
| 902 | |
Johannes Berg | 62ae67b | 2009-11-18 18:42:05 +0100 | [diff] [blame] | 903 | ieee80211_tx_skb(sdata, skb); |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 904 | } |
| 905 | |
Felix Fietkau | d524215 | 2010-01-08 18:06:26 +0100 | [diff] [blame] | 906 | static void ieee80211_send_4addr_nullfunc(struct ieee80211_local *local, |
| 907 | struct ieee80211_sub_if_data *sdata) |
| 908 | { |
| 909 | struct sk_buff *skb; |
| 910 | struct ieee80211_hdr *nullfunc; |
| 911 | __le16 fc; |
| 912 | |
| 913 | if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION)) |
| 914 | return; |
| 915 | |
| 916 | skb = dev_alloc_skb(local->hw.extra_tx_headroom + 30); |
Joe Perches | d15b845 | 2011-08-29 14:17:31 -0700 | [diff] [blame] | 917 | if (!skb) |
Felix Fietkau | d524215 | 2010-01-08 18:06:26 +0100 | [diff] [blame] | 918 | return; |
Joe Perches | d15b845 | 2011-08-29 14:17:31 -0700 | [diff] [blame] | 919 | |
Felix Fietkau | d524215 | 2010-01-08 18:06:26 +0100 | [diff] [blame] | 920 | skb_reserve(skb, local->hw.extra_tx_headroom); |
| 921 | |
| 922 | nullfunc = (struct ieee80211_hdr *) skb_put(skb, 30); |
| 923 | memset(nullfunc, 0, 30); |
| 924 | fc = cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_NULLFUNC | |
| 925 | IEEE80211_FCTL_FROMDS | IEEE80211_FCTL_TODS); |
| 926 | nullfunc->frame_control = fc; |
| 927 | memcpy(nullfunc->addr1, sdata->u.mgd.bssid, ETH_ALEN); |
| 928 | memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN); |
| 929 | memcpy(nullfunc->addr3, sdata->u.mgd.bssid, ETH_ALEN); |
| 930 | memcpy(nullfunc->addr4, sdata->vif.addr, ETH_ALEN); |
| 931 | |
| 932 | IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; |
| 933 | ieee80211_tx_skb(sdata, skb); |
| 934 | } |
| 935 | |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 936 | /* spectrum management related things */ |
| 937 | static void ieee80211_chswitch_work(struct work_struct *work) |
| 938 | { |
| 939 | struct ieee80211_sub_if_data *sdata = |
| 940 | container_of(work, struct ieee80211_sub_if_data, u.mgd.chswitch_work); |
Karl Beldan | 675a0b0 | 2013-03-25 16:26:57 +0100 | [diff] [blame] | 941 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 942 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 943 | int ret; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 944 | |
Johannes Berg | 9607e6b | 2009-12-23 13:15:31 +0100 | [diff] [blame] | 945 | if (!ieee80211_sdata_running(sdata)) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 946 | return; |
| 947 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 948 | sdata_lock(sdata); |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 949 | mutex_lock(&local->mtx); |
| 950 | mutex_lock(&local->chanctx_mtx); |
| 951 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 952 | if (!ifmgd->associated) |
| 953 | goto out; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 954 | |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 955 | if (!sdata->vif.csa_active) |
| 956 | goto out; |
| 957 | |
| 958 | /* |
| 959 | * using reservation isn't immediate as it may be deferred until later |
| 960 | * with multi-vif. once reservation is complete it will re-schedule the |
| 961 | * work with no reserved_chanctx so verify chandef to check if it |
| 962 | * completed successfully |
| 963 | */ |
| 964 | |
| 965 | if (sdata->reserved_chanctx) { |
| 966 | /* |
| 967 | * with multi-vif csa driver may call ieee80211_csa_finish() |
| 968 | * many times while waiting for other interfaces to use their |
| 969 | * reservations |
| 970 | */ |
| 971 | if (sdata->reserved_ready) |
| 972 | goto out; |
| 973 | |
| 974 | ret = ieee80211_vif_use_reserved_context(sdata); |
| 975 | if (ret) { |
| 976 | sdata_info(sdata, |
| 977 | "failed to use reserved channel context, disconnecting (err=%d)\n", |
| 978 | ret); |
| 979 | ieee80211_queue_work(&sdata->local->hw, |
| 980 | &ifmgd->csa_connection_drop_work); |
| 981 | goto out; |
| 982 | } |
| 983 | |
| 984 | goto out; |
| 985 | } |
| 986 | |
| 987 | if (!cfg80211_chandef_identical(&sdata->vif.bss_conf.chandef, |
| 988 | &sdata->csa_chandef)) { |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 989 | sdata_info(sdata, |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 990 | "failed to finalize channel switch, disconnecting\n"); |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 991 | ieee80211_queue_work(&sdata->local->hw, |
| 992 | &ifmgd->csa_connection_drop_work); |
| 993 | goto out; |
| 994 | } |
Karl Beldan | 675a0b0 | 2013-03-25 16:26:57 +0100 | [diff] [blame] | 995 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 996 | /* XXX: shouldn't really modify cfg80211-owned data! */ |
Luciano Coelho | 33787fc | 2013-11-11 20:34:54 +0200 | [diff] [blame] | 997 | ifmgd->associated->channel = sdata->csa_chandef.chan; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 998 | |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 999 | sdata->vif.csa_active = false; |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1000 | |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1001 | /* XXX: wait for a beacon first? */ |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 1002 | if (sdata->csa_block_tx) { |
| 1003 | ieee80211_wake_vif_queues(local, sdata, |
| 1004 | IEEE80211_QUEUE_STOP_REASON_CSA); |
| 1005 | sdata->csa_block_tx = false; |
| 1006 | } |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1007 | |
Michal Kazior | e5593f5 | 2014-04-09 15:45:36 +0200 | [diff] [blame] | 1008 | ieee80211_sta_reset_beacon_monitor(sdata); |
| 1009 | ieee80211_sta_reset_conn_monitor(sdata); |
| 1010 | |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1011 | out: |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1012 | mutex_unlock(&local->chanctx_mtx); |
| 1013 | mutex_unlock(&local->mtx); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 1014 | sdata_unlock(sdata); |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1015 | } |
| 1016 | |
Johannes Berg | 5ce6e43 | 2010-05-11 16:20:57 +0200 | [diff] [blame] | 1017 | void ieee80211_chswitch_done(struct ieee80211_vif *vif, bool success) |
| 1018 | { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1019 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
| 1020 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 5ce6e43 | 2010-05-11 16:20:57 +0200 | [diff] [blame] | 1021 | |
| 1022 | trace_api_chswitch_done(sdata, success); |
| 1023 | if (!success) { |
Johannes Berg | 882a7c6 | 2012-08-01 22:32:45 +0200 | [diff] [blame] | 1024 | sdata_info(sdata, |
| 1025 | "driver channel switch failed, disconnecting\n"); |
| 1026 | ieee80211_queue_work(&sdata->local->hw, |
| 1027 | &ifmgd->csa_connection_drop_work); |
| 1028 | } else { |
| 1029 | ieee80211_queue_work(&sdata->local->hw, &ifmgd->chswitch_work); |
Johannes Berg | 5ce6e43 | 2010-05-11 16:20:57 +0200 | [diff] [blame] | 1030 | } |
Johannes Berg | 5ce6e43 | 2010-05-11 16:20:57 +0200 | [diff] [blame] | 1031 | } |
| 1032 | EXPORT_SYMBOL(ieee80211_chswitch_done); |
| 1033 | |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1034 | static void ieee80211_chswitch_timer(unsigned long data) |
| 1035 | { |
| 1036 | struct ieee80211_sub_if_data *sdata = |
| 1037 | (struct ieee80211_sub_if_data *) data; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1038 | |
Stanislaw Gruszka | 9b7d72c | 2013-02-28 10:55:27 +0100 | [diff] [blame] | 1039 | ieee80211_queue_work(&sdata->local->hw, &sdata->u.mgd.chswitch_work); |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1040 | } |
| 1041 | |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 1042 | static void |
Johannes Berg | 4a3cb70 | 2013-02-12 16:43:19 +0100 | [diff] [blame] | 1043 | ieee80211_sta_process_chanswitch(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 04a161f | 2013-05-03 09:35:35 +0200 | [diff] [blame] | 1044 | u64 timestamp, struct ieee802_11_elems *elems, |
| 1045 | bool beacon) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1046 | { |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1047 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1048 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 1049 | struct cfg80211_bss *cbss = ifmgd->associated; |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1050 | struct ieee80211_chanctx_conf *conf; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1051 | struct ieee80211_chanctx *chanctx; |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1052 | enum ieee80211_band current_band; |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1053 | struct ieee80211_csa_ie csa_ie; |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1054 | int res; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1055 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 1056 | sdata_assert_lock(sdata); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 1057 | |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 1058 | if (!cbss) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1059 | return; |
| 1060 | |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1061 | if (local->scanning) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1062 | return; |
| 1063 | |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 1064 | /* disregard subsequent announcements if we are already processing */ |
Luciano Coelho | 3e2a022 | 2014-07-05 11:43:01 +0300 | [diff] [blame] | 1065 | if (sdata->vif.csa_active) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1066 | return; |
| 1067 | |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1068 | current_band = cbss->channel->band; |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1069 | memset(&csa_ie, 0, sizeof(csa_ie)); |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1070 | res = ieee80211_parse_ch_switch_ie(sdata, elems, beacon, current_band, |
| 1071 | ifmgd->flags, |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1072 | ifmgd->associated->bssid, &csa_ie); |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1073 | if (res < 0) |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1074 | ieee80211_queue_work(&local->hw, |
Johannes Berg | 882a7c6 | 2012-08-01 22:32:45 +0200 | [diff] [blame] | 1075 | &ifmgd->csa_connection_drop_work); |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1076 | if (res) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1077 | return; |
Johannes Berg | cd64f2a | 2013-03-28 10:44:18 +0100 | [diff] [blame] | 1078 | |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1079 | if (!cfg80211_chandef_usable(local->hw.wiphy, &csa_ie.chandef, |
Johannes Berg | 85220d7 | 2013-03-25 18:29:27 +0100 | [diff] [blame] | 1080 | IEEE80211_CHAN_DISABLED)) { |
| 1081 | sdata_info(sdata, |
| 1082 | "AP %pM switches to unsupported channel (%d MHz, width:%d, CF1/2: %d/%d MHz), disconnecting\n", |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 1083 | ifmgd->associated->bssid, |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1084 | csa_ie.chandef.chan->center_freq, |
| 1085 | csa_ie.chandef.width, csa_ie.chandef.center_freq1, |
| 1086 | csa_ie.chandef.center_freq2); |
Johannes Berg | 85220d7 | 2013-03-25 18:29:27 +0100 | [diff] [blame] | 1087 | ieee80211_queue_work(&local->hw, |
| 1088 | &ifmgd->csa_connection_drop_work); |
| 1089 | return; |
| 1090 | } |
| 1091 | |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1092 | mutex_lock(&local->mtx); |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1093 | mutex_lock(&local->chanctx_mtx); |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1094 | conf = rcu_dereference_protected(sdata->vif.chanctx_conf, |
| 1095 | lockdep_is_held(&local->chanctx_mtx)); |
| 1096 | if (!conf) { |
| 1097 | sdata_info(sdata, |
| 1098 | "no channel context assigned to vif?, disconnecting\n"); |
| 1099 | ieee80211_queue_work(&local->hw, |
| 1100 | &ifmgd->csa_connection_drop_work); |
| 1101 | mutex_unlock(&local->chanctx_mtx); |
| 1102 | mutex_unlock(&local->mtx); |
| 1103 | return; |
| 1104 | } |
| 1105 | |
| 1106 | chanctx = container_of(conf, struct ieee80211_chanctx, conf); |
| 1107 | |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 1108 | if (local->use_chanctx) { |
| 1109 | u32 num_chanctx = 0; |
| 1110 | list_for_each_entry(chanctx, &local->chanctx_list, list) |
| 1111 | num_chanctx++; |
| 1112 | |
| 1113 | if (num_chanctx > 1 || |
| 1114 | !(local->hw.flags & IEEE80211_HW_CHANCTX_STA_CSA)) { |
| 1115 | sdata_info(sdata, |
| 1116 | "not handling chan-switch with channel contexts\n"); |
| 1117 | ieee80211_queue_work(&local->hw, |
| 1118 | &ifmgd->csa_connection_drop_work); |
| 1119 | mutex_unlock(&local->chanctx_mtx); |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1120 | mutex_unlock(&local->mtx); |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 1121 | return; |
| 1122 | } |
| 1123 | } |
| 1124 | |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1125 | res = ieee80211_vif_reserve_chanctx(sdata, &csa_ie.chandef, |
| 1126 | chanctx->mode, false); |
| 1127 | if (res) { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1128 | sdata_info(sdata, |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1129 | "failed to reserve channel context for channel switch, disconnecting (err=%d)\n", |
| 1130 | res); |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1131 | ieee80211_queue_work(&local->hw, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1132 | &ifmgd->csa_connection_drop_work); |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1133 | mutex_unlock(&local->chanctx_mtx); |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1134 | mutex_unlock(&local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1135 | return; |
| 1136 | } |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1137 | mutex_unlock(&local->chanctx_mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1138 | |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1139 | sdata->vif.csa_active = true; |
Michal Kazior | 4c3ebc5 | 2014-06-25 12:35:09 +0200 | [diff] [blame] | 1140 | sdata->csa_chandef = csa_ie.chandef; |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1141 | sdata->csa_block_tx = csa_ie.mode; |
| 1142 | |
| 1143 | if (sdata->csa_block_tx) |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 1144 | ieee80211_stop_vif_queues(local, sdata, |
| 1145 | IEEE80211_QUEUE_STOP_REASON_CSA); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1146 | mutex_unlock(&local->mtx); |
Johannes Berg | 57eebdf | 2012-08-01 15:50:46 +0200 | [diff] [blame] | 1147 | |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1148 | if (local->ops->channel_switch) { |
Johannes Berg | 5ce6e43 | 2010-05-11 16:20:57 +0200 | [diff] [blame] | 1149 | /* use driver's channel switch callback */ |
Johannes Berg | 57eebdf | 2012-08-01 15:50:46 +0200 | [diff] [blame] | 1150 | struct ieee80211_channel_switch ch_switch = { |
| 1151 | .timestamp = timestamp, |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1152 | .block_tx = csa_ie.mode, |
| 1153 | .chandef = csa_ie.chandef, |
| 1154 | .count = csa_ie.count, |
Johannes Berg | 57eebdf | 2012-08-01 15:50:46 +0200 | [diff] [blame] | 1155 | }; |
| 1156 | |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1157 | drv_channel_switch(local, &ch_switch); |
Johannes Berg | 5ce6e43 | 2010-05-11 16:20:57 +0200 | [diff] [blame] | 1158 | return; |
| 1159 | } |
| 1160 | |
| 1161 | /* channel switch handled in software */ |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1162 | if (csa_ie.count <= 1) |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 1163 | ieee80211_queue_work(&local->hw, &ifmgd->chswitch_work); |
Johannes Berg | 57eebdf | 2012-08-01 15:50:46 +0200 | [diff] [blame] | 1164 | else |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1165 | mod_timer(&ifmgd->chswitch_timer, |
Chun-Yeow Yeoh | c0f17eb | 2013-10-14 19:08:29 -0700 | [diff] [blame] | 1166 | TU_TO_EXP_TIME(csa_ie.count * cbss->beacon_interval)); |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1167 | } |
| 1168 | |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 1169 | static u32 ieee80211_handle_pwr_constr(struct ieee80211_sub_if_data *sdata, |
| 1170 | struct ieee80211_channel *channel, |
| 1171 | const u8 *country_ie, u8 country_ie_len, |
| 1172 | const u8 *pwr_constr_elem) |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1173 | { |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 1174 | struct ieee80211_country_ie_triplet *triplet; |
| 1175 | int chan = ieee80211_frequency_to_channel(channel->center_freq); |
| 1176 | int i, chan_pwr, chan_increment, new_ap_level; |
| 1177 | bool have_chan_pwr = false; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1178 | |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 1179 | /* Invalid IE */ |
| 1180 | if (country_ie_len % 2 || country_ie_len < IEEE80211_COUNTRY_IE_MIN_LEN) |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 1181 | return 0; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1182 | |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 1183 | triplet = (void *)(country_ie + 3); |
| 1184 | country_ie_len -= 3; |
| 1185 | |
| 1186 | switch (channel->band) { |
| 1187 | default: |
| 1188 | WARN_ON_ONCE(1); |
| 1189 | /* fall through */ |
| 1190 | case IEEE80211_BAND_2GHZ: |
| 1191 | case IEEE80211_BAND_60GHZ: |
| 1192 | chan_increment = 1; |
| 1193 | break; |
| 1194 | case IEEE80211_BAND_5GHZ: |
| 1195 | chan_increment = 4; |
| 1196 | break; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1197 | } |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 1198 | |
| 1199 | /* find channel */ |
| 1200 | while (country_ie_len >= 3) { |
| 1201 | u8 first_channel = triplet->chans.first_channel; |
| 1202 | |
| 1203 | if (first_channel >= IEEE80211_COUNTRY_EXTENSION_ID) |
| 1204 | goto next; |
| 1205 | |
| 1206 | for (i = 0; i < triplet->chans.num_channels; i++) { |
| 1207 | if (first_channel + i * chan_increment == chan) { |
| 1208 | have_chan_pwr = true; |
| 1209 | chan_pwr = triplet->chans.max_power; |
| 1210 | break; |
| 1211 | } |
| 1212 | } |
| 1213 | if (have_chan_pwr) |
| 1214 | break; |
| 1215 | |
| 1216 | next: |
| 1217 | triplet++; |
| 1218 | country_ie_len -= 3; |
| 1219 | } |
| 1220 | |
| 1221 | if (!have_chan_pwr) |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 1222 | return 0; |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 1223 | |
| 1224 | new_ap_level = max_t(int, 0, chan_pwr - *pwr_constr_elem); |
| 1225 | |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 1226 | if (sdata->ap_power_level == new_ap_level) |
| 1227 | return 0; |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 1228 | |
| 1229 | sdata_info(sdata, |
| 1230 | "Limiting TX power to %d (%d - %d) dBm as advertised by %pM\n", |
| 1231 | new_ap_level, chan_pwr, *pwr_constr_elem, |
| 1232 | sdata->u.mgd.bssid); |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 1233 | sdata->ap_power_level = new_ap_level; |
| 1234 | if (__ieee80211_recalc_txpower(sdata)) |
| 1235 | return BSS_CHANGED_TXPOWER; |
| 1236 | return 0; |
Johannes Berg | cc32abd | 2009-05-15 11:52:31 +0200 | [diff] [blame] | 1237 | } |
| 1238 | |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1239 | /* powersave */ |
| 1240 | static void ieee80211_enable_ps(struct ieee80211_local *local, |
| 1241 | struct ieee80211_sub_if_data *sdata) |
| 1242 | { |
| 1243 | struct ieee80211_conf *conf = &local->hw.conf; |
| 1244 | |
Johannes Berg | d5edaed | 2009-04-22 23:02:51 +0200 | [diff] [blame] | 1245 | /* |
| 1246 | * If we are scanning right now then the parameters will |
| 1247 | * take effect when scan finishes. |
| 1248 | */ |
Helmut Schaa | fbe9c42 | 2009-07-23 12:14:04 +0200 | [diff] [blame] | 1249 | if (local->scanning) |
Johannes Berg | d5edaed | 2009-04-22 23:02:51 +0200 | [diff] [blame] | 1250 | return; |
| 1251 | |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1252 | if (conf->dynamic_ps_timeout > 0 && |
| 1253 | !(local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_PS)) { |
| 1254 | mod_timer(&local->dynamic_ps_timer, jiffies + |
| 1255 | msecs_to_jiffies(conf->dynamic_ps_timeout)); |
| 1256 | } else { |
| 1257 | if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) |
| 1258 | ieee80211_send_nullfunc(local, sdata, 1); |
Vivek Natarajan | 375177b | 2010-02-09 14:50:28 +0530 | [diff] [blame] | 1259 | |
Juuso Oikarinen | 2a13052 | 2010-03-09 14:25:02 +0200 | [diff] [blame] | 1260 | if ((local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) && |
| 1261 | (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)) |
| 1262 | return; |
| 1263 | |
| 1264 | conf->flags |= IEEE80211_CONF_PS; |
| 1265 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1266 | } |
| 1267 | } |
| 1268 | |
| 1269 | static void ieee80211_change_ps(struct ieee80211_local *local) |
| 1270 | { |
| 1271 | struct ieee80211_conf *conf = &local->hw.conf; |
| 1272 | |
| 1273 | if (local->ps_sdata) { |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1274 | ieee80211_enable_ps(local, local->ps_sdata); |
| 1275 | } else if (conf->flags & IEEE80211_CONF_PS) { |
| 1276 | conf->flags &= ~IEEE80211_CONF_PS; |
| 1277 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); |
| 1278 | del_timer_sync(&local->dynamic_ps_timer); |
| 1279 | cancel_work_sync(&local->dynamic_ps_enable_work); |
| 1280 | } |
| 1281 | } |
| 1282 | |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1283 | static bool ieee80211_powersave_allowed(struct ieee80211_sub_if_data *sdata) |
| 1284 | { |
| 1285 | struct ieee80211_if_managed *mgd = &sdata->u.mgd; |
| 1286 | struct sta_info *sta = NULL; |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 1287 | bool authorized = false; |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1288 | |
| 1289 | if (!mgd->powersave) |
| 1290 | return false; |
| 1291 | |
Johannes Berg | 05cb910 | 2011-10-28 11:59:47 +0200 | [diff] [blame] | 1292 | if (mgd->broken_ap) |
| 1293 | return false; |
| 1294 | |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1295 | if (!mgd->associated) |
| 1296 | return false; |
| 1297 | |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 1298 | if (mgd->flags & IEEE80211_STA_CONNECTION_POLL) |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1299 | return false; |
| 1300 | |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 1301 | if (!mgd->have_beacon) |
Alexander Bondar | ce85788 | 2013-05-06 17:17:04 +0300 | [diff] [blame] | 1302 | return false; |
| 1303 | |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1304 | rcu_read_lock(); |
| 1305 | sta = sta_info_get(sdata, mgd->bssid); |
| 1306 | if (sta) |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 1307 | authorized = test_sta_flag(sta, WLAN_STA_AUTHORIZED); |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1308 | rcu_read_unlock(); |
| 1309 | |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 1310 | return authorized; |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1311 | } |
| 1312 | |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1313 | /* need to hold RTNL or interface lock */ |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1314 | void ieee80211_recalc_ps(struct ieee80211_local *local, s32 latency) |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1315 | { |
| 1316 | struct ieee80211_sub_if_data *sdata, *found = NULL; |
| 1317 | int count = 0; |
Juuso Oikarinen | 195e294 | 2010-04-27 12:47:40 +0300 | [diff] [blame] | 1318 | int timeout; |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1319 | |
| 1320 | if (!(local->hw.flags & IEEE80211_HW_SUPPORTS_PS)) { |
| 1321 | local->ps_sdata = NULL; |
| 1322 | return; |
| 1323 | } |
| 1324 | |
| 1325 | list_for_each_entry(sdata, &local->interfaces, list) { |
Johannes Berg | 9607e6b | 2009-12-23 13:15:31 +0100 | [diff] [blame] | 1326 | if (!ieee80211_sdata_running(sdata)) |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1327 | continue; |
Rajkumar Manoharan | 8c7914d | 2011-02-01 00:28:59 +0530 | [diff] [blame] | 1328 | if (sdata->vif.type == NL80211_IFTYPE_AP) { |
| 1329 | /* If an AP vif is found, then disable PS |
| 1330 | * by setting the count to zero thereby setting |
| 1331 | * ps_sdata to NULL. |
| 1332 | */ |
| 1333 | count = 0; |
| 1334 | break; |
| 1335 | } |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1336 | if (sdata->vif.type != NL80211_IFTYPE_STATION) |
| 1337 | continue; |
| 1338 | found = sdata; |
| 1339 | count++; |
| 1340 | } |
| 1341 | |
Jason Young | 808118c | 2011-03-10 16:43:19 -0800 | [diff] [blame] | 1342 | if (count == 1 && ieee80211_powersave_allowed(found)) { |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1343 | s32 beaconint_us; |
| 1344 | |
| 1345 | if (latency < 0) |
Mark Gross | ed77134 | 2010-05-06 01:59:26 +0200 | [diff] [blame] | 1346 | latency = pm_qos_request(PM_QOS_NETWORK_LATENCY); |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1347 | |
| 1348 | beaconint_us = ieee80211_tu_to_usec( |
| 1349 | found->vif.bss_conf.beacon_int); |
| 1350 | |
Juuso Oikarinen | ff61638 | 2010-06-09 09:51:52 +0300 | [diff] [blame] | 1351 | timeout = local->dynamic_ps_forced_timeout; |
Juuso Oikarinen | 195e294 | 2010-04-27 12:47:40 +0300 | [diff] [blame] | 1352 | if (timeout < 0) { |
| 1353 | /* |
Juuso Oikarinen | ff61638 | 2010-06-09 09:51:52 +0300 | [diff] [blame] | 1354 | * Go to full PSM if the user configures a very low |
| 1355 | * latency requirement. |
Eliad Peller | 0ab82b0 | 2010-12-03 02:16:23 +0200 | [diff] [blame] | 1356 | * The 2000 second value is there for compatibility |
| 1357 | * until the PM_QOS_NETWORK_LATENCY is configured |
| 1358 | * with real values. |
Juuso Oikarinen | 195e294 | 2010-04-27 12:47:40 +0300 | [diff] [blame] | 1359 | */ |
Eliad Peller | 0ab82b0 | 2010-12-03 02:16:23 +0200 | [diff] [blame] | 1360 | if (latency > (1900 * USEC_PER_MSEC) && |
| 1361 | latency != (2000 * USEC_PER_SEC)) |
Juuso Oikarinen | 195e294 | 2010-04-27 12:47:40 +0300 | [diff] [blame] | 1362 | timeout = 0; |
Juuso Oikarinen | ff61638 | 2010-06-09 09:51:52 +0300 | [diff] [blame] | 1363 | else |
| 1364 | timeout = 100; |
Juuso Oikarinen | 195e294 | 2010-04-27 12:47:40 +0300 | [diff] [blame] | 1365 | } |
Johannes Berg | 09b8556 | 2013-02-06 23:07:41 +0100 | [diff] [blame] | 1366 | local->hw.conf.dynamic_ps_timeout = timeout; |
Juuso Oikarinen | 195e294 | 2010-04-27 12:47:40 +0300 | [diff] [blame] | 1367 | |
Johannes Berg | 04fe203 | 2009-04-22 18:44:37 +0200 | [diff] [blame] | 1368 | if (beaconint_us > latency) { |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1369 | local->ps_sdata = NULL; |
Johannes Berg | 04fe203 | 2009-04-22 18:44:37 +0200 | [diff] [blame] | 1370 | } else { |
Johannes Berg | 04fe203 | 2009-04-22 18:44:37 +0200 | [diff] [blame] | 1371 | int maxslp = 1; |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 1372 | u8 dtimper = found->u.mgd.dtim_period; |
Johannes Berg | 56007a0 | 2010-01-26 14:19:52 +0100 | [diff] [blame] | 1373 | |
| 1374 | /* If the TIM IE is invalid, pretend the value is 1 */ |
| 1375 | if (!dtimper) |
| 1376 | dtimper = 1; |
| 1377 | else if (dtimper > 1) |
Johannes Berg | 04fe203 | 2009-04-22 18:44:37 +0200 | [diff] [blame] | 1378 | maxslp = min_t(int, dtimper, |
| 1379 | latency / beaconint_us); |
| 1380 | |
Johannes Berg | 9ccebe6 | 2009-04-23 10:32:36 +0200 | [diff] [blame] | 1381 | local->hw.conf.max_sleep_period = maxslp; |
Johannes Berg | 56007a0 | 2010-01-26 14:19:52 +0100 | [diff] [blame] | 1382 | local->hw.conf.ps_dtim_period = dtimper; |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1383 | local->ps_sdata = found; |
Johannes Berg | 04fe203 | 2009-04-22 18:44:37 +0200 | [diff] [blame] | 1384 | } |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1385 | } else { |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1386 | local->ps_sdata = NULL; |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 1387 | } |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1388 | |
| 1389 | ieee80211_change_ps(local); |
| 1390 | } |
| 1391 | |
Eliad Peller | ab09587 | 2012-07-27 12:33:22 +0300 | [diff] [blame] | 1392 | void ieee80211_recalc_ps_vif(struct ieee80211_sub_if_data *sdata) |
| 1393 | { |
| 1394 | bool ps_allowed = ieee80211_powersave_allowed(sdata); |
| 1395 | |
| 1396 | if (sdata->vif.bss_conf.ps != ps_allowed) { |
| 1397 | sdata->vif.bss_conf.ps = ps_allowed; |
| 1398 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_PS); |
| 1399 | } |
| 1400 | } |
| 1401 | |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1402 | void ieee80211_dynamic_ps_disable_work(struct work_struct *work) |
| 1403 | { |
| 1404 | struct ieee80211_local *local = |
| 1405 | container_of(work, struct ieee80211_local, |
| 1406 | dynamic_ps_disable_work); |
| 1407 | |
| 1408 | if (local->hw.conf.flags & IEEE80211_CONF_PS) { |
| 1409 | local->hw.conf.flags &= ~IEEE80211_CONF_PS; |
| 1410 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); |
| 1411 | } |
| 1412 | |
| 1413 | ieee80211_wake_queues_by_reason(&local->hw, |
Johannes Berg | 445ea4e | 2013-02-13 12:25:28 +0100 | [diff] [blame] | 1414 | IEEE80211_MAX_QUEUE_MAP, |
Luciano Coelho | cca07b0 | 2014-06-13 16:30:05 +0300 | [diff] [blame] | 1415 | IEEE80211_QUEUE_STOP_REASON_PS, |
| 1416 | false); |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1417 | } |
| 1418 | |
| 1419 | void ieee80211_dynamic_ps_enable_work(struct work_struct *work) |
| 1420 | { |
| 1421 | struct ieee80211_local *local = |
| 1422 | container_of(work, struct ieee80211_local, |
| 1423 | dynamic_ps_enable_work); |
| 1424 | struct ieee80211_sub_if_data *sdata = local->ps_sdata; |
Christian Lamparter | 5e34069 | 2011-06-30 21:08:43 +0200 | [diff] [blame] | 1425 | struct ieee80211_if_managed *ifmgd; |
Rajkumar Manoharan | 1ddc286 | 2011-05-03 17:03:59 +0530 | [diff] [blame] | 1426 | unsigned long flags; |
| 1427 | int q; |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1428 | |
| 1429 | /* can only happen when PS was just disabled anyway */ |
| 1430 | if (!sdata) |
| 1431 | return; |
| 1432 | |
Christian Lamparter | 5e34069 | 2011-06-30 21:08:43 +0200 | [diff] [blame] | 1433 | ifmgd = &sdata->u.mgd; |
| 1434 | |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1435 | if (local->hw.conf.flags & IEEE80211_CONF_PS) |
| 1436 | return; |
| 1437 | |
Johannes Berg | 09b8556 | 2013-02-06 23:07:41 +0100 | [diff] [blame] | 1438 | if (local->hw.conf.dynamic_ps_timeout > 0) { |
Arik Nemtsov | 77b7023 | 2011-06-26 12:06:54 +0300 | [diff] [blame] | 1439 | /* don't enter PS if TX frames are pending */ |
| 1440 | if (drv_tx_frames_pending(local)) { |
Rajkumar Manoharan | 1ddc286 | 2011-05-03 17:03:59 +0530 | [diff] [blame] | 1441 | mod_timer(&local->dynamic_ps_timer, jiffies + |
| 1442 | msecs_to_jiffies( |
| 1443 | local->hw.conf.dynamic_ps_timeout)); |
| 1444 | return; |
| 1445 | } |
Arik Nemtsov | 77b7023 | 2011-06-26 12:06:54 +0300 | [diff] [blame] | 1446 | |
| 1447 | /* |
| 1448 | * transmission can be stopped by others which leads to |
| 1449 | * dynamic_ps_timer expiry. Postpone the ps timer if it |
| 1450 | * is not the actual idle state. |
| 1451 | */ |
| 1452 | spin_lock_irqsave(&local->queue_stop_reason_lock, flags); |
| 1453 | for (q = 0; q < local->hw.queues; q++) { |
| 1454 | if (local->queue_stop_reasons[q]) { |
| 1455 | spin_unlock_irqrestore(&local->queue_stop_reason_lock, |
| 1456 | flags); |
| 1457 | mod_timer(&local->dynamic_ps_timer, jiffies + |
| 1458 | msecs_to_jiffies( |
| 1459 | local->hw.conf.dynamic_ps_timeout)); |
| 1460 | return; |
| 1461 | } |
| 1462 | } |
| 1463 | spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); |
Rajkumar Manoharan | 1ddc286 | 2011-05-03 17:03:59 +0530 | [diff] [blame] | 1464 | } |
Rajkumar Manoharan | 1ddc286 | 2011-05-03 17:03:59 +0530 | [diff] [blame] | 1465 | |
Vivek Natarajan | 375177b | 2010-02-09 14:50:28 +0530 | [diff] [blame] | 1466 | if ((local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) && |
Mohammed Shafi Shajakhan | 9c38a8b | 2011-12-14 19:46:07 +0530 | [diff] [blame] | 1467 | !(ifmgd->flags & IEEE80211_STA_NULLFUNC_ACKED)) { |
Johannes Berg | a159838 | 2013-03-26 22:02:42 +0100 | [diff] [blame] | 1468 | if (drv_tx_frames_pending(local)) { |
Vivek Natarajan | e8306f9 | 2011-04-06 11:41:10 +0530 | [diff] [blame] | 1469 | mod_timer(&local->dynamic_ps_timer, jiffies + |
| 1470 | msecs_to_jiffies( |
| 1471 | local->hw.conf.dynamic_ps_timeout)); |
Johannes Berg | a159838 | 2013-03-26 22:02:42 +0100 | [diff] [blame] | 1472 | } else { |
Vivek Natarajan | e8306f9 | 2011-04-06 11:41:10 +0530 | [diff] [blame] | 1473 | ieee80211_send_nullfunc(local, sdata, 1); |
| 1474 | /* Flush to get the tx status of nullfunc frame */ |
Johannes Berg | 39ecc01 | 2013-02-13 12:11:00 +0100 | [diff] [blame] | 1475 | ieee80211_flush_queues(local, sdata); |
Vivek Natarajan | e8306f9 | 2011-04-06 11:41:10 +0530 | [diff] [blame] | 1476 | } |
Vivek Natarajan | f3e85b9 | 2011-02-23 13:04:32 +0530 | [diff] [blame] | 1477 | } |
| 1478 | |
Juuso Oikarinen | 2a13052 | 2010-03-09 14:25:02 +0200 | [diff] [blame] | 1479 | if (!((local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) && |
| 1480 | (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK)) || |
Vivek Natarajan | 375177b | 2010-02-09 14:50:28 +0530 | [diff] [blame] | 1481 | (ifmgd->flags & IEEE80211_STA_NULLFUNC_ACKED)) { |
| 1482 | ifmgd->flags &= ~IEEE80211_STA_NULLFUNC_ACKED; |
| 1483 | local->hw.conf.flags |= IEEE80211_CONF_PS; |
| 1484 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); |
| 1485 | } |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1486 | } |
| 1487 | |
| 1488 | void ieee80211_dynamic_ps_timer(unsigned long data) |
| 1489 | { |
| 1490 | struct ieee80211_local *local = (void *) data; |
| 1491 | |
Luis R. Rodriguez | 78f1a8b | 2009-07-27 08:38:25 -0700 | [diff] [blame] | 1492 | if (local->quiescing || local->suspended) |
Johannes Berg | 5bb644a | 2009-05-17 11:40:42 +0200 | [diff] [blame] | 1493 | return; |
| 1494 | |
Luis R. Rodriguez | 42935ec | 2009-07-29 20:08:07 -0400 | [diff] [blame] | 1495 | ieee80211_queue_work(&local->hw, &local->dynamic_ps_enable_work); |
Johannes Berg | 965beda | 2009-04-16 13:17:24 +0200 | [diff] [blame] | 1496 | } |
| 1497 | |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 1498 | void ieee80211_dfs_cac_timer_work(struct work_struct *work) |
| 1499 | { |
| 1500 | struct delayed_work *delayed_work = |
| 1501 | container_of(work, struct delayed_work, work); |
| 1502 | struct ieee80211_sub_if_data *sdata = |
| 1503 | container_of(delayed_work, struct ieee80211_sub_if_data, |
| 1504 | dfs_cac_timer_work); |
Janusz Dziedzic | d2859df | 2013-11-06 13:55:51 +0100 | [diff] [blame] | 1505 | struct cfg80211_chan_def chandef = sdata->vif.bss_conf.chandef; |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 1506 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1507 | mutex_lock(&sdata->local->mtx); |
| 1508 | if (sdata->wdev.cac_started) { |
| 1509 | ieee80211_vif_release_channel(sdata); |
| 1510 | cfg80211_cac_event(sdata->dev, &chandef, |
| 1511 | NL80211_RADAR_CAC_FINISHED, |
| 1512 | GFP_KERNEL); |
| 1513 | } |
| 1514 | mutex_unlock(&sdata->local->mtx); |
Simon Wunderlich | 164eb02 | 2013-02-08 18:16:20 +0100 | [diff] [blame] | 1515 | } |
| 1516 | |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 1517 | /* MLME */ |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1518 | static bool ieee80211_sta_wmm_params(struct ieee80211_local *local, |
Johannes Berg | 4ced3f7 | 2010-07-19 16:39:04 +0200 | [diff] [blame] | 1519 | struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 4a3cb70 | 2013-02-12 16:43:19 +0100 | [diff] [blame] | 1520 | const u8 *wmm_param, size_t wmm_param_len) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1521 | { |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1522 | struct ieee80211_tx_queue_params params; |
Johannes Berg | 4ced3f7 | 2010-07-19 16:39:04 +0200 | [diff] [blame] | 1523 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1524 | size_t left; |
| 1525 | int count; |
Johannes Berg | 4a3cb70 | 2013-02-12 16:43:19 +0100 | [diff] [blame] | 1526 | const u8 *pos; |
| 1527 | u8 uapsd_queues = 0; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1528 | |
Stanislaw Gruszka | e1b3ec1 | 2010-03-29 12:18:34 +0200 | [diff] [blame] | 1529 | if (!local->ops->conf_tx) |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1530 | return false; |
Stanislaw Gruszka | e1b3ec1 | 2010-03-29 12:18:34 +0200 | [diff] [blame] | 1531 | |
Johannes Berg | 32c5057 | 2012-03-28 11:04:29 +0200 | [diff] [blame] | 1532 | if (local->hw.queues < IEEE80211_NUM_ACS) |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1533 | return false; |
Johannes Berg | 3434fbd | 2008-05-03 00:59:37 +0200 | [diff] [blame] | 1534 | |
| 1535 | if (!wmm_param) |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1536 | return false; |
Johannes Berg | 3434fbd | 2008-05-03 00:59:37 +0200 | [diff] [blame] | 1537 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1538 | if (wmm_param_len < 8 || wmm_param[5] /* version */ != 1) |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1539 | return false; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1540 | |
| 1541 | if (ifmgd->flags & IEEE80211_STA_UAPSD_ENABLED) |
Eliad Peller | dc41e4d | 2012-03-14 16:15:03 +0200 | [diff] [blame] | 1542 | uapsd_queues = ifmgd->uapsd_queues; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1543 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1544 | count = wmm_param[6] & 0x0f; |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 1545 | if (count == ifmgd->wmm_last_param_set) |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1546 | return false; |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 1547 | ifmgd->wmm_last_param_set = count; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1548 | |
| 1549 | pos = wmm_param + 8; |
| 1550 | left = wmm_param_len - 8; |
| 1551 | |
| 1552 | memset(¶ms, 0, sizeof(params)); |
| 1553 | |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 1554 | sdata->wmm_acm = 0; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1555 | for (; left >= 4; left -= 4, pos += 4) { |
| 1556 | int aci = (pos[0] >> 5) & 0x03; |
| 1557 | int acm = (pos[0] >> 4) & 0x01; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1558 | bool uapsd = false; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1559 | int queue; |
| 1560 | |
| 1561 | switch (aci) { |
Jouni Malinen | 0eeb59f | 2009-03-05 17:23:46 +0200 | [diff] [blame] | 1562 | case 1: /* AC_BK */ |
Johannes Berg | e100bb6 | 2008-04-30 18:51:21 +0200 | [diff] [blame] | 1563 | queue = 3; |
Johannes Berg | 988c0f7 | 2008-04-17 19:21:22 +0200 | [diff] [blame] | 1564 | if (acm) |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 1565 | sdata->wmm_acm |= BIT(1) | BIT(2); /* BK/- */ |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1566 | if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BK) |
| 1567 | uapsd = true; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1568 | break; |
Jouni Malinen | 0eeb59f | 2009-03-05 17:23:46 +0200 | [diff] [blame] | 1569 | case 2: /* AC_VI */ |
Johannes Berg | e100bb6 | 2008-04-30 18:51:21 +0200 | [diff] [blame] | 1570 | queue = 1; |
Johannes Berg | 988c0f7 | 2008-04-17 19:21:22 +0200 | [diff] [blame] | 1571 | if (acm) |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 1572 | sdata->wmm_acm |= BIT(4) | BIT(5); /* CL/VI */ |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1573 | if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VI) |
| 1574 | uapsd = true; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1575 | break; |
Jouni Malinen | 0eeb59f | 2009-03-05 17:23:46 +0200 | [diff] [blame] | 1576 | case 3: /* AC_VO */ |
Johannes Berg | e100bb6 | 2008-04-30 18:51:21 +0200 | [diff] [blame] | 1577 | queue = 0; |
Johannes Berg | 988c0f7 | 2008-04-17 19:21:22 +0200 | [diff] [blame] | 1578 | if (acm) |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 1579 | sdata->wmm_acm |= BIT(6) | BIT(7); /* VO/NC */ |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1580 | if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_VO) |
| 1581 | uapsd = true; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1582 | break; |
Jouni Malinen | 0eeb59f | 2009-03-05 17:23:46 +0200 | [diff] [blame] | 1583 | case 0: /* AC_BE */ |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1584 | default: |
Johannes Berg | e100bb6 | 2008-04-30 18:51:21 +0200 | [diff] [blame] | 1585 | queue = 2; |
Johannes Berg | 988c0f7 | 2008-04-17 19:21:22 +0200 | [diff] [blame] | 1586 | if (acm) |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 1587 | sdata->wmm_acm |= BIT(0) | BIT(3); /* BE/EE */ |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1588 | if (uapsd_queues & IEEE80211_WMM_IE_STA_QOSINFO_AC_BE) |
| 1589 | uapsd = true; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1590 | break; |
| 1591 | } |
| 1592 | |
| 1593 | params.aifs = pos[0] & 0x0f; |
| 1594 | params.cw_max = ecw2cw((pos[1] & 0xf0) >> 4); |
| 1595 | params.cw_min = ecw2cw(pos[1] & 0x0f); |
Johannes Berg | f434b2d | 2008-07-10 11:22:31 +0200 | [diff] [blame] | 1596 | params.txop = get_unaligned_le16(pos + 2); |
Alexander Bondar | 908f8d0 | 2013-04-07 09:53:30 +0300 | [diff] [blame] | 1597 | params.acm = acm; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 1598 | params.uapsd = uapsd; |
| 1599 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 1600 | mlme_dbg(sdata, |
| 1601 | "WMM queue=%d aci=%d acm=%d aifs=%d cWmin=%d cWmax=%d txop=%d uapsd=%d\n", |
| 1602 | queue, aci, acm, |
| 1603 | params.aifs, params.cw_min, params.cw_max, |
| 1604 | params.txop, params.uapsd); |
Eliad Peller | f6f3def | 2011-09-25 20:06:54 +0300 | [diff] [blame] | 1605 | sdata->tx_conf[queue] = params; |
| 1606 | if (drv_conf_tx(local, sdata, queue, ¶ms)) |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 1607 | sdata_err(sdata, |
| 1608 | "failed to set TX queue parameters for queue %d\n", |
| 1609 | queue); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1610 | } |
Stanislaw Gruszka | e1b3ec1 | 2010-03-29 12:18:34 +0200 | [diff] [blame] | 1611 | |
| 1612 | /* enable WMM or activate new settings */ |
Johannes Berg | 4ced3f7 | 2010-07-19 16:39:04 +0200 | [diff] [blame] | 1613 | sdata->vif.bss_conf.qos = true; |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 1614 | return true; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1615 | } |
| 1616 | |
Stanislaw Gruszka | 925e64c | 2012-05-16 15:27:20 +0200 | [diff] [blame] | 1617 | static void __ieee80211_stop_poll(struct ieee80211_sub_if_data *sdata) |
| 1618 | { |
| 1619 | lockdep_assert_held(&sdata->local->mtx); |
| 1620 | |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 1621 | sdata->u.mgd.flags &= ~IEEE80211_STA_CONNECTION_POLL; |
Stanislaw Gruszka | 925e64c | 2012-05-16 15:27:20 +0200 | [diff] [blame] | 1622 | ieee80211_run_deferred_scan(sdata->local); |
| 1623 | } |
| 1624 | |
| 1625 | static void ieee80211_stop_poll(struct ieee80211_sub_if_data *sdata) |
| 1626 | { |
| 1627 | mutex_lock(&sdata->local->mtx); |
| 1628 | __ieee80211_stop_poll(sdata); |
| 1629 | mutex_unlock(&sdata->local->mtx); |
| 1630 | } |
| 1631 | |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 1632 | static u32 ieee80211_handle_bss_capability(struct ieee80211_sub_if_data *sdata, |
| 1633 | u16 capab, bool erp_valid, u8 erp) |
Daniel Drake | 5628221 | 2007-07-10 19:32:10 +0200 | [diff] [blame] | 1634 | { |
Johannes Berg | bda3933 | 2008-10-11 01:51:51 +0200 | [diff] [blame] | 1635 | struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf; |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 1636 | u32 changed = 0; |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 1637 | bool use_protection; |
| 1638 | bool use_short_preamble; |
| 1639 | bool use_short_slot; |
| 1640 | |
| 1641 | if (erp_valid) { |
| 1642 | use_protection = (erp & WLAN_ERP_USE_PROTECTION) != 0; |
| 1643 | use_short_preamble = (erp & WLAN_ERP_BARKER_PREAMBLE) == 0; |
| 1644 | } else { |
| 1645 | use_protection = false; |
| 1646 | use_short_preamble = !!(capab & WLAN_CAPABILITY_SHORT_PREAMBLE); |
| 1647 | } |
| 1648 | |
| 1649 | use_short_slot = !!(capab & WLAN_CAPABILITY_SHORT_SLOT_TIME); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1650 | if (ieee80211_get_sdata_band(sdata) == IEEE80211_BAND_5GHZ) |
Felix Fietkau | 43d3534 | 2010-01-15 03:00:48 +0100 | [diff] [blame] | 1651 | use_short_slot = true; |
Daniel Drake | 5628221 | 2007-07-10 19:32:10 +0200 | [diff] [blame] | 1652 | |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 1653 | if (use_protection != bss_conf->use_cts_prot) { |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 1654 | bss_conf->use_cts_prot = use_protection; |
| 1655 | changed |= BSS_CHANGED_ERP_CTS_PROT; |
Daniel Drake | 5628221 | 2007-07-10 19:32:10 +0200 | [diff] [blame] | 1656 | } |
Daniel Drake | 7e9ed18 | 2007-07-27 15:43:24 +0200 | [diff] [blame] | 1657 | |
Vladimir Koutny | d43c7b3 | 2008-03-31 17:05:03 +0200 | [diff] [blame] | 1658 | if (use_short_preamble != bss_conf->use_short_preamble) { |
Vladimir Koutny | d43c7b3 | 2008-03-31 17:05:03 +0200 | [diff] [blame] | 1659 | bss_conf->use_short_preamble = use_short_preamble; |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 1660 | changed |= BSS_CHANGED_ERP_PREAMBLE; |
Daniel Drake | 7e9ed18 | 2007-07-27 15:43:24 +0200 | [diff] [blame] | 1661 | } |
Daniel Drake | d9430a3 | 2007-07-27 15:43:24 +0200 | [diff] [blame] | 1662 | |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 1663 | if (use_short_slot != bss_conf->use_short_slot) { |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 1664 | bss_conf->use_short_slot = use_short_slot; |
| 1665 | changed |= BSS_CHANGED_ERP_SLOT; |
John W. Linville | 50c4afb | 2008-04-15 14:09:27 -0400 | [diff] [blame] | 1666 | } |
| 1667 | |
| 1668 | return changed; |
| 1669 | } |
| 1670 | |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 1671 | static void ieee80211_set_associated(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 1672 | struct cfg80211_bss *cbss, |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 1673 | u32 bss_info_changed) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1674 | { |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 1675 | struct ieee80211_bss *bss = (void *)cbss->priv; |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 1676 | struct ieee80211_local *local = sdata->local; |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1677 | struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf; |
Jiri Slaby | d6f2da5 | 2007-08-28 17:01:54 -0400 | [diff] [blame] | 1678 | |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 1679 | bss_info_changed |= BSS_CHANGED_ASSOC; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 1680 | bss_info_changed |= ieee80211_handle_bss_capability(sdata, |
Luciano Coelho | 50ae34a | 2012-06-20 17:23:24 +0300 | [diff] [blame] | 1681 | bss_conf->assoc_capability, bss->has_erp_value, bss->erp_value); |
Tomas Winkler | 21c0cbe | 2008-03-28 16:33:34 -0700 | [diff] [blame] | 1682 | |
Felix Fietkau | 7ccc8bd | 2010-11-19 22:55:38 +0100 | [diff] [blame] | 1683 | sdata->u.mgd.beacon_timeout = usecs_to_jiffies(ieee80211_tu_to_usec( |
Ben Greear | 59c1ec2 | 2013-03-19 14:19:56 -0700 | [diff] [blame] | 1684 | beacon_loss_count * bss_conf->beacon_int)); |
Felix Fietkau | 7ccc8bd | 2010-11-19 22:55:38 +0100 | [diff] [blame] | 1685 | |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 1686 | sdata->u.mgd.associated = cbss; |
| 1687 | memcpy(sdata->u.mgd.bssid, cbss->bssid, ETH_ALEN); |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 1688 | |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 1689 | sdata->u.mgd.flags |= IEEE80211_STA_RESET_SIGNAL_AVE; |
| 1690 | |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 1691 | if (sdata->vif.p2p) { |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1692 | const struct cfg80211_bss_ies *ies; |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 1693 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1694 | rcu_read_lock(); |
| 1695 | ies = rcu_dereference(cbss->ies); |
| 1696 | if (ies) { |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1697 | int ret; |
| 1698 | |
| 1699 | ret = cfg80211_get_p2p_attr( |
| 1700 | ies->data, ies->len, |
| 1701 | IEEE80211_P2P_ATTR_ABSENCE_NOTICE, |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 1702 | (u8 *) &bss_conf->p2p_noa_attr, |
| 1703 | sizeof(bss_conf->p2p_noa_attr)); |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1704 | if (ret >= 2) { |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 1705 | sdata->u.mgd.p2p_noa_index = |
| 1706 | bss_conf->p2p_noa_attr.index; |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1707 | bss_info_changed |= BSS_CHANGED_P2P_PS; |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1708 | } |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 1709 | } |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1710 | rcu_read_unlock(); |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 1711 | } |
| 1712 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1713 | /* just to be sure */ |
Stanislaw Gruszka | 925e64c | 2012-05-16 15:27:20 +0200 | [diff] [blame] | 1714 | ieee80211_stop_poll(sdata); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1715 | |
Tomas Winkler | f5e5bf2 | 2008-09-08 17:33:39 +0200 | [diff] [blame] | 1716 | ieee80211_led_assoc(local, 1); |
| 1717 | |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 1718 | if (sdata->u.mgd.have_beacon) { |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 1719 | /* |
| 1720 | * If the AP is buggy we may get here with no DTIM period |
| 1721 | * known, so assume it's 1 which is the only safe assumption |
| 1722 | * in that case, although if the TIM IE is broken powersave |
| 1723 | * probably just won't work at all. |
| 1724 | */ |
| 1725 | bss_conf->dtim_period = sdata->u.mgd.dtim_period ?: 1; |
Alexander Bondar | 817cee7 | 2013-05-19 14:23:57 +0300 | [diff] [blame] | 1726 | bss_conf->beacon_rate = bss->beacon_rate; |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 1727 | bss_info_changed |= BSS_CHANGED_BEACON_INFO; |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 1728 | } else { |
Alexander Bondar | 817cee7 | 2013-05-19 14:23:57 +0300 | [diff] [blame] | 1729 | bss_conf->beacon_rate = NULL; |
Johannes Berg | e5b900d | 2010-07-29 16:08:55 +0200 | [diff] [blame] | 1730 | bss_conf->dtim_period = 0; |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 1731 | } |
Johannes Berg | e5b900d | 2010-07-29 16:08:55 +0200 | [diff] [blame] | 1732 | |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1733 | bss_conf->assoc = 1; |
Johannes Berg | 9cef873 | 2009-05-14 13:10:14 +0200 | [diff] [blame] | 1734 | |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 1735 | /* Tell the driver to monitor connection quality (if supported) */ |
Johannes Berg | ea08635 | 2012-01-19 09:29:58 +0100 | [diff] [blame] | 1736 | if (sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI && |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1737 | bss_conf->cqm_rssi_thold) |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 1738 | bss_info_changed |= BSS_CHANGED_CQM; |
| 1739 | |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1740 | /* Enable ARP filtering */ |
Johannes Berg | 0f19b41 | 2013-01-14 16:39:07 +0100 | [diff] [blame] | 1741 | if (bss_conf->arp_addr_cnt) |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1742 | bss_info_changed |= BSS_CHANGED_ARP_FILTER; |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1743 | |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 1744 | ieee80211_bss_info_change_notify(sdata, bss_info_changed); |
Guy Cohen | 8db9369 | 2008-07-03 19:56:13 +0300 | [diff] [blame] | 1745 | |
Johannes Berg | 056508d | 2009-07-30 21:43:55 +0200 | [diff] [blame] | 1746 | mutex_lock(&local->iflist_mtx); |
| 1747 | ieee80211_recalc_ps(local, -1); |
| 1748 | mutex_unlock(&local->iflist_mtx); |
Kalle Valo | e0cb686 | 2008-12-18 23:35:13 +0200 | [diff] [blame] | 1749 | |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 1750 | ieee80211_recalc_smps(sdata); |
Eliad Peller | ab09587 | 2012-07-27 12:33:22 +0300 | [diff] [blame] | 1751 | ieee80211_recalc_ps_vif(sdata); |
| 1752 | |
Tomas Winkler | f5e5bf2 | 2008-09-08 17:33:39 +0200 | [diff] [blame] | 1753 | netif_carrier_on(sdata->dev); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1754 | } |
| 1755 | |
Jouni Malinen | e69e95d | 2010-03-29 23:29:31 -0700 | [diff] [blame] | 1756 | static void ieee80211_set_disassoc(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1757 | u16 stype, u16 reason, bool tx, |
| 1758 | u8 *frame_buf) |
Tomas Winkler | aa458d1 | 2008-09-09 00:32:12 +0300 | [diff] [blame] | 1759 | { |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 1760 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Tomas Winkler | aa458d1 | 2008-09-09 00:32:12 +0300 | [diff] [blame] | 1761 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 3cc5240 | 2012-03-09 13:12:35 +0100 | [diff] [blame] | 1762 | u32 changed = 0; |
Tomas Winkler | aa458d1 | 2008-09-09 00:32:12 +0300 | [diff] [blame] | 1763 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 1764 | sdata_assert_lock(sdata); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 1765 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1766 | if (WARN_ON_ONCE(tx && !frame_buf)) |
| 1767 | return; |
| 1768 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1769 | if (WARN_ON(!ifmgd->associated)) |
| 1770 | return; |
| 1771 | |
David Spinadel | 79543d8 | 2012-06-12 09:59:45 +0300 | [diff] [blame] | 1772 | ieee80211_stop_poll(sdata); |
| 1773 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 1774 | ifmgd->associated = NULL; |
Tomas Winkler | aa458d1 | 2008-09-09 00:32:12 +0300 | [diff] [blame] | 1775 | netif_carrier_off(sdata->dev); |
| 1776 | |
Eliad Peller | 88bc40e | 2012-07-12 17:35:33 +0300 | [diff] [blame] | 1777 | /* |
| 1778 | * if we want to get out of ps before disassoc (why?) we have |
| 1779 | * to do it before sending disassoc, as otherwise the null-packet |
| 1780 | * won't be valid. |
| 1781 | */ |
| 1782 | if (local->hw.conf.flags & IEEE80211_CONF_PS) { |
| 1783 | local->hw.conf.flags &= ~IEEE80211_CONF_PS; |
| 1784 | ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS); |
| 1785 | } |
| 1786 | local->ps_sdata = NULL; |
| 1787 | |
Eliad Peller | ab09587 | 2012-07-27 12:33:22 +0300 | [diff] [blame] | 1788 | /* disable per-vif ps */ |
| 1789 | ieee80211_recalc_ps_vif(sdata); |
| 1790 | |
Eliad Peller | f823981 | 2012-06-27 14:18:22 +0300 | [diff] [blame] | 1791 | /* flush out any pending frame (e.g. DELBA) before deauth/disassoc */ |
| 1792 | if (tx) |
Johannes Berg | 39ecc01 | 2013-02-13 12:11:00 +0100 | [diff] [blame] | 1793 | ieee80211_flush_queues(local, sdata); |
Eliad Peller | f823981 | 2012-06-27 14:18:22 +0300 | [diff] [blame] | 1794 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1795 | /* deauthenticate/disassociate now */ |
| 1796 | if (tx || frame_buf) |
Eliad Peller | 88a9e31 | 2012-06-01 11:14:03 +0300 | [diff] [blame] | 1797 | ieee80211_send_deauth_disassoc(sdata, ifmgd->bssid, stype, |
| 1798 | reason, tx, frame_buf); |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1799 | |
| 1800 | /* flush out frame */ |
| 1801 | if (tx) |
Johannes Berg | 39ecc01 | 2013-02-13 12:11:00 +0100 | [diff] [blame] | 1802 | ieee80211_flush_queues(local, sdata); |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1803 | |
Eliad Peller | 88a9e31 | 2012-06-01 11:14:03 +0300 | [diff] [blame] | 1804 | /* clear bssid only after building the needed mgmt frames */ |
| 1805 | memset(ifmgd->bssid, 0, ETH_ALEN); |
| 1806 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1807 | /* remove AP and TDLS peers */ |
Johannes Berg | d34ba21 | 2013-12-04 22:46:11 +0100 | [diff] [blame] | 1808 | sta_info_flush(sdata); |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 1809 | |
| 1810 | /* finally reset all BSS / config parameters */ |
Tomas Winkler | f5e5bf2 | 2008-09-08 17:33:39 +0200 | [diff] [blame] | 1811 | changed |= ieee80211_reset_erp_info(sdata); |
| 1812 | |
Tomas Winkler | f5e5bf2 | 2008-09-08 17:33:39 +0200 | [diff] [blame] | 1813 | ieee80211_led_assoc(local, 0); |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 1814 | changed |= BSS_CHANGED_ASSOC; |
| 1815 | sdata->vif.bss_conf.assoc = false; |
Tomas Winkler | f5e5bf2 | 2008-09-08 17:33:39 +0200 | [diff] [blame] | 1816 | |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 1817 | ifmgd->p2p_noa_index = -1; |
| 1818 | memset(&sdata->vif.bss_conf.p2p_noa_attr, 0, |
| 1819 | sizeof(sdata->vif.bss_conf.p2p_noa_attr)); |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 1820 | |
Johannes Berg | dd5ecfe | 2013-02-21 17:40:19 +0100 | [diff] [blame] | 1821 | /* on the next assoc, re-program HT/VHT parameters */ |
Ben Greear | ef96a842 | 2011-11-18 11:32:00 -0800 | [diff] [blame] | 1822 | memset(&ifmgd->ht_capa, 0, sizeof(ifmgd->ht_capa)); |
| 1823 | memset(&ifmgd->ht_capa_mask, 0, sizeof(ifmgd->ht_capa_mask)); |
Johannes Berg | dd5ecfe | 2013-02-21 17:40:19 +0100 | [diff] [blame] | 1824 | memset(&ifmgd->vht_capa, 0, sizeof(ifmgd->vht_capa)); |
| 1825 | memset(&ifmgd->vht_capa_mask, 0, sizeof(ifmgd->vht_capa_mask)); |
Johannes Berg | 413ad50 | 2009-05-08 21:21:06 +0200 | [diff] [blame] | 1826 | |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 1827 | sdata->ap_power_level = IEEE80211_UNSET_POWER_LEVEL; |
Vasanthakumar Thiagarajan | a8302de | 2009-01-09 18:14:15 +0530 | [diff] [blame] | 1828 | |
Kalle Valo | 520eb82 | 2008-12-18 23:35:27 +0200 | [diff] [blame] | 1829 | del_timer_sync(&local->dynamic_ps_timer); |
| 1830 | cancel_work_sync(&local->dynamic_ps_enable_work); |
| 1831 | |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1832 | /* Disable ARP filtering */ |
Johannes Berg | 0f19b41 | 2013-01-14 16:39:07 +0100 | [diff] [blame] | 1833 | if (sdata->vif.bss_conf.arp_addr_cnt) |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1834 | changed |= BSS_CHANGED_ARP_FILTER; |
Juuso Oikarinen | 6854296 | 2010-06-09 13:43:26 +0300 | [diff] [blame] | 1835 | |
Johannes Berg | 3abead5 | 2012-03-02 15:56:59 +0100 | [diff] [blame] | 1836 | sdata->vif.bss_conf.qos = false; |
| 1837 | changed |= BSS_CHANGED_QOS; |
| 1838 | |
Johannes Berg | 0aaffa9 | 2010-05-05 15:28:27 +0200 | [diff] [blame] | 1839 | /* The BSSID (not really interesting) and HT changed */ |
| 1840 | changed |= BSS_CHANGED_BSSID | BSS_CHANGED_HT; |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 1841 | ieee80211_bss_info_change_notify(sdata, changed); |
Tomas Winkler | 8e268e4 | 2008-11-25 13:05:44 +0200 | [diff] [blame] | 1842 | |
Johannes Berg | 3abead5 | 2012-03-02 15:56:59 +0100 | [diff] [blame] | 1843 | /* disassociated - set to defaults now */ |
| 1844 | ieee80211_set_wmm_default(sdata, false); |
| 1845 | |
Johannes Berg | b9dcf71 | 2010-08-27 12:35:54 +0200 | [diff] [blame] | 1846 | del_timer_sync(&sdata->u.mgd.conn_mon_timer); |
| 1847 | del_timer_sync(&sdata->u.mgd.bcn_mon_timer); |
| 1848 | del_timer_sync(&sdata->u.mgd.timer); |
| 1849 | del_timer_sync(&sdata->u.mgd.chswitch_timer); |
Johannes Berg | 2d9957c | 2012-08-01 20:54:52 +0200 | [diff] [blame] | 1850 | |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 1851 | sdata->vif.bss_conf.dtim_period = 0; |
Alexander Bondar | 817cee7 | 2013-05-19 14:23:57 +0300 | [diff] [blame] | 1852 | sdata->vif.bss_conf.beacon_rate = NULL; |
| 1853 | |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 1854 | ifmgd->have_beacon = false; |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 1855 | |
Johannes Berg | 028e8da0 | 2012-11-26 11:57:41 +0100 | [diff] [blame] | 1856 | ifmgd->flags = 0; |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1857 | mutex_lock(&local->mtx); |
Johannes Berg | 028e8da0 | 2012-11-26 11:57:41 +0100 | [diff] [blame] | 1858 | ieee80211_vif_release_channel(sdata); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 1859 | |
| 1860 | sdata->vif.csa_active = false; |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 1861 | if (sdata->csa_block_tx) { |
| 1862 | ieee80211_wake_vif_queues(local, sdata, |
| 1863 | IEEE80211_QUEUE_STOP_REASON_CSA); |
| 1864 | sdata->csa_block_tx = false; |
| 1865 | } |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 1866 | mutex_unlock(&local->mtx); |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 1867 | |
| 1868 | sdata->encrypt_headroom = IEEE80211_ENCRYPT_HEADROOM; |
Tomas Winkler | aa458d1 | 2008-09-09 00:32:12 +0300 | [diff] [blame] | 1869 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1870 | |
Kalle Valo | 3cf335d | 2009-03-22 21:57:06 +0200 | [diff] [blame] | 1871 | void ieee80211_sta_rx_notify(struct ieee80211_sub_if_data *sdata, |
| 1872 | struct ieee80211_hdr *hdr) |
| 1873 | { |
| 1874 | /* |
| 1875 | * We can postpone the mgd.timer whenever receiving unicast frames |
| 1876 | * from AP because we know that the connection is working both ways |
| 1877 | * at that time. But multicast frames (and hence also beacons) must |
| 1878 | * be ignored here, because we need to trigger the timer during |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1879 | * data idle periods for sending the periodic probe request to the |
| 1880 | * AP we're connected to. |
Kalle Valo | 3cf335d | 2009-03-22 21:57:06 +0200 | [diff] [blame] | 1881 | */ |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1882 | if (is_multicast_ether_addr(hdr->addr1)) |
| 1883 | return; |
| 1884 | |
Luis R. Rodriguez | be099e8 | 2010-09-16 15:12:29 -0400 | [diff] [blame] | 1885 | ieee80211_sta_reset_conn_monitor(sdata); |
Kalle Valo | 3cf335d | 2009-03-22 21:57:06 +0200 | [diff] [blame] | 1886 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1887 | |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1888 | static void ieee80211_reset_ap_probe(struct ieee80211_sub_if_data *sdata) |
| 1889 | { |
| 1890 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 1891 | struct ieee80211_local *local = sdata->local; |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1892 | |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 1893 | mutex_lock(&local->mtx); |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 1894 | if (!(ifmgd->flags & IEEE80211_STA_CONNECTION_POLL)) |
| 1895 | goto out; |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1896 | |
Stanislaw Gruszka | 925e64c | 2012-05-16 15:27:20 +0200 | [diff] [blame] | 1897 | __ieee80211_stop_poll(sdata); |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 1898 | |
| 1899 | mutex_lock(&local->iflist_mtx); |
| 1900 | ieee80211_recalc_ps(local, -1); |
| 1901 | mutex_unlock(&local->iflist_mtx); |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1902 | |
| 1903 | if (sdata->local->hw.flags & IEEE80211_HW_CONNECTION_MONITOR) |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 1904 | goto out; |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1905 | |
| 1906 | /* |
| 1907 | * We've received a probe response, but are not sure whether |
| 1908 | * we have or will be receiving any beacons or data, so let's |
| 1909 | * schedule the timers again, just in case. |
| 1910 | */ |
| 1911 | ieee80211_sta_reset_beacon_monitor(sdata); |
| 1912 | |
| 1913 | mod_timer(&ifmgd->conn_mon_timer, |
| 1914 | round_jiffies_up(jiffies + |
| 1915 | IEEE80211_CONNECTION_IDLE_TIME)); |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 1916 | out: |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 1917 | mutex_unlock(&local->mtx); |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1918 | } |
| 1919 | |
| 1920 | void ieee80211_sta_tx_notify(struct ieee80211_sub_if_data *sdata, |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 1921 | struct ieee80211_hdr *hdr, bool ack) |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1922 | { |
Felix Fietkau | 75706d0 | 2010-12-02 21:01:07 +0100 | [diff] [blame] | 1923 | if (!ieee80211_is_data(hdr->frame_control)) |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1924 | return; |
| 1925 | |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1926 | if (ieee80211_is_nullfunc(hdr->frame_control) && |
| 1927 | sdata->u.mgd.probe_send_count > 0) { |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 1928 | if (ack) |
Wojciech Dubowik | cab1c7f | 2013-02-14 14:08:37 +0100 | [diff] [blame] | 1929 | ieee80211_sta_reset_conn_monitor(sdata); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 1930 | else |
| 1931 | sdata->u.mgd.nullfunc_failed = true; |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1932 | ieee80211_queue_work(&sdata->local->hw, &sdata->work); |
Wojciech Dubowik | cab1c7f | 2013-02-14 14:08:37 +0100 | [diff] [blame] | 1933 | return; |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1934 | } |
Wojciech Dubowik | cab1c7f | 2013-02-14 14:08:37 +0100 | [diff] [blame] | 1935 | |
| 1936 | if (ack) |
| 1937 | ieee80211_sta_reset_conn_monitor(sdata); |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1938 | } |
| 1939 | |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 1940 | static void ieee80211_mgd_probe_ap_send(struct ieee80211_sub_if_data *sdata) |
| 1941 | { |
| 1942 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 1943 | const u8 *ssid; |
Luis R. Rodriguez | f01a067 | 2010-09-16 15:12:34 -0400 | [diff] [blame] | 1944 | u8 *dst = ifmgd->associated->bssid; |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 1945 | u8 unicast_limit = max(1, max_probe_tries - 3); |
Luis R. Rodriguez | f01a067 | 2010-09-16 15:12:34 -0400 | [diff] [blame] | 1946 | |
| 1947 | /* |
| 1948 | * Try sending broadcast probe requests for the last three |
| 1949 | * probe requests after the first ones failed since some |
| 1950 | * buggy APs only support broadcast probe requests. |
| 1951 | */ |
| 1952 | if (ifmgd->probe_send_count >= unicast_limit) |
| 1953 | dst = NULL; |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 1954 | |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1955 | /* |
| 1956 | * When the hardware reports an accurate Tx ACK status, it's |
| 1957 | * better to send a nullfunc frame instead of a probe request, |
| 1958 | * as it will kick us off the AP quickly if we aren't associated |
| 1959 | * anymore. The timeout will be reset if the frame is ACKed by |
| 1960 | * the AP. |
| 1961 | */ |
Soumik Das | 992e68b | 2012-05-20 15:31:13 +0530 | [diff] [blame] | 1962 | ifmgd->probe_send_count++; |
| 1963 | |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 1964 | if (sdata->local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) { |
| 1965 | ifmgd->nullfunc_failed = false; |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1966 | ieee80211_send_nullfunc(sdata->local, sdata, 0); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 1967 | } else { |
Stanislaw Gruszka | 88c868c | 2012-03-29 16:30:41 +0200 | [diff] [blame] | 1968 | int ssid_len; |
| 1969 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1970 | rcu_read_lock(); |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1971 | ssid = ieee80211_bss_get_ie(ifmgd->associated, WLAN_EID_SSID); |
Stanislaw Gruszka | 88c868c | 2012-03-29 16:30:41 +0200 | [diff] [blame] | 1972 | if (WARN_ON_ONCE(ssid == NULL)) |
| 1973 | ssid_len = 0; |
| 1974 | else |
| 1975 | ssid_len = ssid[1]; |
| 1976 | |
| 1977 | ieee80211_send_probe_req(sdata, dst, ssid + 2, ssid_len, NULL, |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 1978 | 0, (u32) -1, true, 0, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 1979 | ifmgd->associated->channel, false); |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 1980 | rcu_read_unlock(); |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 1981 | } |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 1982 | |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 1983 | ifmgd->probe_timeout = jiffies + msecs_to_jiffies(probe_wait_ms); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 1984 | run_again(sdata, ifmgd->probe_timeout); |
Rajkumar Manoharan | f69b9c7 | 2012-03-15 06:15:26 +0530 | [diff] [blame] | 1985 | if (sdata->local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) |
Johannes Berg | 39ecc01 | 2013-02-13 12:11:00 +0100 | [diff] [blame] | 1986 | ieee80211_flush_queues(sdata->local, sdata); |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 1987 | } |
| 1988 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1989 | static void ieee80211_mgd_probe_ap(struct ieee80211_sub_if_data *sdata, |
| 1990 | bool beacon) |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 1991 | { |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 1992 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 1993 | bool already = false; |
Johannes Berg | 34bfc41 | 2009-05-12 19:58:12 +0200 | [diff] [blame] | 1994 | |
Johannes Berg | 9607e6b | 2009-12-23 13:15:31 +0100 | [diff] [blame] | 1995 | if (!ieee80211_sdata_running(sdata)) |
Johannes Berg | 0e2b628 | 2009-07-13 13:23:39 +0200 | [diff] [blame] | 1996 | return; |
| 1997 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 1998 | sdata_lock(sdata); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 1999 | |
| 2000 | if (!ifmgd->associated) |
| 2001 | goto out; |
| 2002 | |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 2003 | mutex_lock(&sdata->local->mtx); |
| 2004 | |
| 2005 | if (sdata->local->tmp_channel || sdata->local->scanning) { |
| 2006 | mutex_unlock(&sdata->local->mtx); |
| 2007 | goto out; |
| 2008 | } |
| 2009 | |
Ben Greear | a13fbe5 | 2013-03-25 11:19:35 -0700 | [diff] [blame] | 2010 | if (beacon) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2011 | mlme_dbg_ratelimited(sdata, |
Ben Greear | 59c1ec2 | 2013-03-19 14:19:56 -0700 | [diff] [blame] | 2012 | "detected beacon loss from AP (missed %d beacons) - probing\n", |
| 2013 | beacon_loss_count); |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2014 | |
Ben Greear | a13fbe5 | 2013-03-25 11:19:35 -0700 | [diff] [blame] | 2015 | ieee80211_cqm_rssi_notify(&sdata->vif, |
| 2016 | NL80211_CQM_RSSI_BEACON_LOSS_EVENT, |
| 2017 | GFP_KERNEL); |
| 2018 | } |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 2019 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2020 | /* |
| 2021 | * The driver/our work has already reported this event or the |
| 2022 | * connection monitoring has kicked in and we have already sent |
| 2023 | * a probe request. Or maybe the AP died and the driver keeps |
| 2024 | * reporting until we disassociate... |
| 2025 | * |
| 2026 | * In either case we have to ignore the current call to this |
| 2027 | * function (except for setting the correct probe reason bit) |
| 2028 | * because otherwise we would reset the timer every time and |
| 2029 | * never check whether we received a probe response! |
| 2030 | */ |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 2031 | if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL) |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2032 | already = true; |
| 2033 | |
Eliad Peller | 12b5f34 | 2013-11-18 19:06:46 +0200 | [diff] [blame] | 2034 | ifmgd->flags |= IEEE80211_STA_CONNECTION_POLL; |
| 2035 | |
Stanislaw Gruszka | 133d40f | 2012-03-28 16:01:19 +0200 | [diff] [blame] | 2036 | mutex_unlock(&sdata->local->mtx); |
| 2037 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2038 | if (already) |
| 2039 | goto out; |
| 2040 | |
Johannes Berg | 4e75184 | 2009-06-10 15:16:52 +0200 | [diff] [blame] | 2041 | mutex_lock(&sdata->local->iflist_mtx); |
| 2042 | ieee80211_recalc_ps(sdata->local, -1); |
| 2043 | mutex_unlock(&sdata->local->iflist_mtx); |
| 2044 | |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 2045 | ifmgd->probe_send_count = 0; |
| 2046 | ieee80211_mgd_probe_ap_send(sdata); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2047 | out: |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2048 | sdata_unlock(sdata); |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 2049 | } |
| 2050 | |
Juuso Oikarinen | a619a4c | 2010-11-11 08:50:18 +0200 | [diff] [blame] | 2051 | struct sk_buff *ieee80211_ap_probereq_get(struct ieee80211_hw *hw, |
| 2052 | struct ieee80211_vif *vif) |
| 2053 | { |
| 2054 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
| 2055 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Eliad Peller | d9b3b28 | 2012-06-28 15:03:13 +0300 | [diff] [blame] | 2056 | struct cfg80211_bss *cbss; |
Juuso Oikarinen | a619a4c | 2010-11-11 08:50:18 +0200 | [diff] [blame] | 2057 | struct sk_buff *skb; |
| 2058 | const u8 *ssid; |
Stanislaw Gruszka | 88c868c | 2012-03-29 16:30:41 +0200 | [diff] [blame] | 2059 | int ssid_len; |
Juuso Oikarinen | a619a4c | 2010-11-11 08:50:18 +0200 | [diff] [blame] | 2060 | |
| 2061 | if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION)) |
| 2062 | return NULL; |
| 2063 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2064 | sdata_assert_lock(sdata); |
Juuso Oikarinen | a619a4c | 2010-11-11 08:50:18 +0200 | [diff] [blame] | 2065 | |
Eliad Peller | d9b3b28 | 2012-06-28 15:03:13 +0300 | [diff] [blame] | 2066 | if (ifmgd->associated) |
| 2067 | cbss = ifmgd->associated; |
| 2068 | else if (ifmgd->auth_data) |
| 2069 | cbss = ifmgd->auth_data->bss; |
| 2070 | else if (ifmgd->assoc_data) |
| 2071 | cbss = ifmgd->assoc_data->bss; |
| 2072 | else |
Juuso Oikarinen | a619a4c | 2010-11-11 08:50:18 +0200 | [diff] [blame] | 2073 | return NULL; |
| 2074 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 2075 | rcu_read_lock(); |
Eliad Peller | d9b3b28 | 2012-06-28 15:03:13 +0300 | [diff] [blame] | 2076 | ssid = ieee80211_bss_get_ie(cbss, WLAN_EID_SSID); |
Stanislaw Gruszka | 88c868c | 2012-03-29 16:30:41 +0200 | [diff] [blame] | 2077 | if (WARN_ON_ONCE(ssid == NULL)) |
| 2078 | ssid_len = 0; |
| 2079 | else |
| 2080 | ssid_len = ssid[1]; |
| 2081 | |
Eliad Peller | d9b3b28 | 2012-06-28 15:03:13 +0300 | [diff] [blame] | 2082 | skb = ieee80211_build_probe_req(sdata, cbss->bssid, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2083 | (u32) -1, cbss->channel, |
Johannes Berg | 6b77863 | 2012-07-23 14:53:27 +0200 | [diff] [blame] | 2084 | ssid + 2, ssid_len, |
Johannes Berg | 85a237f | 2011-07-18 18:08:36 +0200 | [diff] [blame] | 2085 | NULL, 0, true); |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 2086 | rcu_read_unlock(); |
Juuso Oikarinen | a619a4c | 2010-11-11 08:50:18 +0200 | [diff] [blame] | 2087 | |
| 2088 | return skb; |
| 2089 | } |
| 2090 | EXPORT_SYMBOL(ieee80211_ap_probereq_get); |
| 2091 | |
Johannes Berg | eef9e54 | 2013-01-29 13:09:34 +0100 | [diff] [blame] | 2092 | static void __ieee80211_disconnect(struct ieee80211_sub_if_data *sdata) |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2093 | { |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 2094 | struct ieee80211_local *local = sdata->local; |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2095 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Antonio Quartulli | 6ae1677 | 2012-09-07 13:28:52 +0200 | [diff] [blame] | 2096 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2097 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2098 | sdata_lock(sdata); |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2099 | if (!ifmgd->associated) { |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2100 | sdata_unlock(sdata); |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2101 | return; |
| 2102 | } |
| 2103 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 2104 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, |
| 2105 | WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY, |
Johannes Berg | eef9e54 | 2013-01-29 13:09:34 +0100 | [diff] [blame] | 2106 | true, frame_buf); |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 2107 | mutex_lock(&local->mtx); |
Arik Nemtsov | 7578d57 | 2013-09-01 17:15:51 +0300 | [diff] [blame] | 2108 | sdata->vif.csa_active = false; |
Luciano Coelho | a46992b | 2014-06-13 16:30:07 +0300 | [diff] [blame] | 2109 | if (sdata->csa_block_tx) { |
| 2110 | ieee80211_wake_vif_queues(local, sdata, |
| 2111 | IEEE80211_QUEUE_STOP_REASON_CSA); |
| 2112 | sdata->csa_block_tx = false; |
| 2113 | } |
Michal Kazior | 59af692 | 2014-04-09 15:10:59 +0200 | [diff] [blame] | 2114 | mutex_unlock(&local->mtx); |
Johannes Berg | 7da7cc1 | 2010-08-05 17:02:38 +0200 | [diff] [blame] | 2115 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2116 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 2117 | IEEE80211_DEAUTH_FRAME_LEN); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2118 | sdata_unlock(sdata); |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2119 | } |
| 2120 | |
Johannes Berg | cc74c0c | 2012-08-01 16:49:34 +0200 | [diff] [blame] | 2121 | static void ieee80211_beacon_connection_loss_work(struct work_struct *work) |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2122 | { |
| 2123 | struct ieee80211_sub_if_data *sdata = |
| 2124 | container_of(work, struct ieee80211_sub_if_data, |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2125 | u.mgd.beacon_connection_loss_work); |
Paul Stewart | a85e1d5 | 2011-12-09 11:01:49 -0800 | [diff] [blame] | 2126 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 2127 | struct sta_info *sta; |
| 2128 | |
| 2129 | if (ifmgd->associated) { |
Mohammed Shafi Shajakhan | 30fa904 | 2011-12-27 18:54:07 +0530 | [diff] [blame] | 2130 | rcu_read_lock(); |
Paul Stewart | a85e1d5 | 2011-12-09 11:01:49 -0800 | [diff] [blame] | 2131 | sta = sta_info_get(sdata, ifmgd->bssid); |
| 2132 | if (sta) |
| 2133 | sta->beacon_loss_count++; |
Mohammed Shafi Shajakhan | 30fa904 | 2011-12-27 18:54:07 +0530 | [diff] [blame] | 2134 | rcu_read_unlock(); |
Paul Stewart | a85e1d5 | 2011-12-09 11:01:49 -0800 | [diff] [blame] | 2135 | } |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2136 | |
Johannes Berg | 682bd38 | 2013-01-29 13:13:50 +0100 | [diff] [blame] | 2137 | if (ifmgd->connection_loss) { |
Johannes Berg | 882a7c6 | 2012-08-01 22:32:45 +0200 | [diff] [blame] | 2138 | sdata_info(sdata, "Connection to AP %pM lost\n", |
| 2139 | ifmgd->bssid); |
Johannes Berg | eef9e54 | 2013-01-29 13:09:34 +0100 | [diff] [blame] | 2140 | __ieee80211_disconnect(sdata); |
Johannes Berg | 882a7c6 | 2012-08-01 22:32:45 +0200 | [diff] [blame] | 2141 | } else { |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2142 | ieee80211_mgd_probe_ap(sdata, true); |
Johannes Berg | 882a7c6 | 2012-08-01 22:32:45 +0200 | [diff] [blame] | 2143 | } |
| 2144 | } |
| 2145 | |
| 2146 | static void ieee80211_csa_connection_drop_work(struct work_struct *work) |
| 2147 | { |
| 2148 | struct ieee80211_sub_if_data *sdata = |
| 2149 | container_of(work, struct ieee80211_sub_if_data, |
| 2150 | u.mgd.csa_connection_drop_work); |
| 2151 | |
Johannes Berg | eef9e54 | 2013-01-29 13:09:34 +0100 | [diff] [blame] | 2152 | __ieee80211_disconnect(sdata); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2153 | } |
| 2154 | |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 2155 | void ieee80211_beacon_loss(struct ieee80211_vif *vif) |
| 2156 | { |
| 2157 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2158 | struct ieee80211_hw *hw = &sdata->local->hw; |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 2159 | |
Johannes Berg | b5878a2 | 2010-04-07 16:48:40 +0200 | [diff] [blame] | 2160 | trace_api_beacon_loss(sdata); |
| 2161 | |
Johannes Berg | 682bd38 | 2013-01-29 13:13:50 +0100 | [diff] [blame] | 2162 | sdata->u.mgd.connection_loss = false; |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2163 | ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work); |
Kalle Valo | 04de838 | 2009-03-22 21:57:35 +0200 | [diff] [blame] | 2164 | } |
| 2165 | EXPORT_SYMBOL(ieee80211_beacon_loss); |
| 2166 | |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2167 | void ieee80211_connection_loss(struct ieee80211_vif *vif) |
| 2168 | { |
| 2169 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
| 2170 | struct ieee80211_hw *hw = &sdata->local->hw; |
| 2171 | |
Johannes Berg | b5878a2 | 2010-04-07 16:48:40 +0200 | [diff] [blame] | 2172 | trace_api_connection_loss(sdata); |
| 2173 | |
Johannes Berg | 682bd38 | 2013-01-29 13:13:50 +0100 | [diff] [blame] | 2174 | sdata->u.mgd.connection_loss = true; |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 2175 | ieee80211_queue_work(hw, &sdata->u.mgd.beacon_connection_loss_work); |
| 2176 | } |
| 2177 | EXPORT_SYMBOL(ieee80211_connection_loss); |
| 2178 | |
| 2179 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2180 | static void ieee80211_destroy_auth_data(struct ieee80211_sub_if_data *sdata, |
| 2181 | bool assoc) |
| 2182 | { |
| 2183 | struct ieee80211_mgd_auth_data *auth_data = sdata->u.mgd.auth_data; |
| 2184 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2185 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2186 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2187 | if (!assoc) { |
| 2188 | sta_info_destroy_addr(sdata, auth_data->bss->bssid); |
| 2189 | |
| 2190 | memset(sdata->u.mgd.bssid, 0, ETH_ALEN); |
| 2191 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID); |
Johannes Berg | 028e8da0 | 2012-11-26 11:57:41 +0100 | [diff] [blame] | 2192 | sdata->u.mgd.flags = 0; |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2193 | mutex_lock(&sdata->local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2194 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2195 | mutex_unlock(&sdata->local->mtx); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2196 | } |
| 2197 | |
Johannes Berg | 5b112d3 | 2013-02-01 01:49:58 +0100 | [diff] [blame] | 2198 | cfg80211_put_bss(sdata->local->hw.wiphy, auth_data->bss); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2199 | kfree(auth_data); |
| 2200 | sdata->u.mgd.auth_data = NULL; |
| 2201 | } |
| 2202 | |
| 2203 | static void ieee80211_auth_challenge(struct ieee80211_sub_if_data *sdata, |
| 2204 | struct ieee80211_mgmt *mgmt, size_t len) |
| 2205 | { |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 2206 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2207 | struct ieee80211_mgd_auth_data *auth_data = sdata->u.mgd.auth_data; |
| 2208 | u8 *pos; |
| 2209 | struct ieee802_11_elems elems; |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 2210 | u32 tx_flags = 0; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2211 | |
| 2212 | pos = mgmt->u.auth.variable; |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 2213 | ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2214 | if (!elems.challenge) |
| 2215 | return; |
| 2216 | auth_data->expected_transaction = 4; |
Johannes Berg | a1845fc | 2012-06-27 13:18:36 +0200 | [diff] [blame] | 2217 | drv_mgd_prepare_tx(sdata->local, sdata); |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 2218 | if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) |
| 2219 | tx_flags = IEEE80211_TX_CTL_REQ_TX_STATUS | |
| 2220 | IEEE80211_TX_INTFL_MLME_CONN_TX; |
Jouni Malinen | 700e8ea | 2012-09-30 19:29:37 +0300 | [diff] [blame] | 2221 | ieee80211_send_auth(sdata, 3, auth_data->algorithm, 0, |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2222 | elems.challenge - 2, elems.challenge_len + 2, |
| 2223 | auth_data->bss->bssid, auth_data->bss->bssid, |
| 2224 | auth_data->key, auth_data->key_len, |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 2225 | auth_data->key_idx, tx_flags); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2226 | } |
| 2227 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2228 | static void ieee80211_rx_mgmt_auth(struct ieee80211_sub_if_data *sdata, |
| 2229 | struct ieee80211_mgmt *mgmt, size_t len) |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2230 | { |
| 2231 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 2232 | u8 bssid[ETH_ALEN]; |
| 2233 | u16 auth_alg, auth_transaction, status_code; |
| 2234 | struct sta_info *sta; |
| 2235 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2236 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2237 | |
| 2238 | if (len < 24 + 6) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2239 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2240 | |
| 2241 | if (!ifmgd->auth_data || ifmgd->auth_data->done) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2242 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2243 | |
| 2244 | memcpy(bssid, ifmgd->auth_data->bss->bssid, ETH_ALEN); |
| 2245 | |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2246 | if (!ether_addr_equal(bssid, mgmt->bssid)) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2247 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2248 | |
| 2249 | auth_alg = le16_to_cpu(mgmt->u.auth.auth_alg); |
| 2250 | auth_transaction = le16_to_cpu(mgmt->u.auth.auth_transaction); |
| 2251 | status_code = le16_to_cpu(mgmt->u.auth.status_code); |
| 2252 | |
| 2253 | if (auth_alg != ifmgd->auth_data->algorithm || |
Jouni Malinen | 0f4126e | 2012-09-30 19:29:38 +0300 | [diff] [blame] | 2254 | auth_transaction != ifmgd->auth_data->expected_transaction) { |
| 2255 | sdata_info(sdata, "%pM unexpected authentication state: alg %d (expected %d) transact %d (expected %d)\n", |
| 2256 | mgmt->sa, auth_alg, ifmgd->auth_data->algorithm, |
| 2257 | auth_transaction, |
| 2258 | ifmgd->auth_data->expected_transaction); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2259 | return; |
Jouni Malinen | 0f4126e | 2012-09-30 19:29:38 +0300 | [diff] [blame] | 2260 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2261 | |
| 2262 | if (status_code != WLAN_STATUS_SUCCESS) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2263 | sdata_info(sdata, "%pM denied authentication (status %d)\n", |
| 2264 | mgmt->sa, status_code); |
Eliad Peller | dac211e | 2012-05-13 18:07:04 +0300 | [diff] [blame] | 2265 | ieee80211_destroy_auth_data(sdata, false); |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2266 | cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2267 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2268 | } |
| 2269 | |
| 2270 | switch (ifmgd->auth_data->algorithm) { |
| 2271 | case WLAN_AUTH_OPEN: |
| 2272 | case WLAN_AUTH_LEAP: |
| 2273 | case WLAN_AUTH_FT: |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 2274 | case WLAN_AUTH_SAE: |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2275 | break; |
| 2276 | case WLAN_AUTH_SHARED_KEY: |
| 2277 | if (ifmgd->auth_data->expected_transaction != 4) { |
| 2278 | ieee80211_auth_challenge(sdata, mgmt, len); |
| 2279 | /* need another frame */ |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2280 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2281 | } |
| 2282 | break; |
| 2283 | default: |
| 2284 | WARN_ONCE(1, "invalid auth alg %d", |
| 2285 | ifmgd->auth_data->algorithm); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2286 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2287 | } |
| 2288 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2289 | sdata_info(sdata, "authenticated\n"); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2290 | ifmgd->auth_data->done = true; |
| 2291 | ifmgd->auth_data->timeout = jiffies + IEEE80211_AUTH_WAIT_ASSOC; |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 2292 | ifmgd->auth_data->timeout_started = true; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2293 | run_again(sdata, ifmgd->auth_data->timeout); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2294 | |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 2295 | if (ifmgd->auth_data->algorithm == WLAN_AUTH_SAE && |
| 2296 | ifmgd->auth_data->expected_transaction != 2) { |
| 2297 | /* |
| 2298 | * Report auth frame to user space for processing since another |
| 2299 | * round of Authentication frames is still needed. |
| 2300 | */ |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2301 | cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2302 | return; |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 2303 | } |
| 2304 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2305 | /* move station state to auth */ |
| 2306 | mutex_lock(&sdata->local->sta_mtx); |
| 2307 | sta = sta_info_get(sdata, bssid); |
| 2308 | if (!sta) { |
| 2309 | WARN_ONCE(1, "%s: STA %pM not found", sdata->name, bssid); |
| 2310 | goto out_err; |
| 2311 | } |
| 2312 | if (sta_info_move_state(sta, IEEE80211_STA_AUTH)) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2313 | sdata_info(sdata, "failed moving %pM to auth\n", bssid); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2314 | goto out_err; |
| 2315 | } |
| 2316 | mutex_unlock(&sdata->local->sta_mtx); |
| 2317 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2318 | cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2319 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2320 | out_err: |
| 2321 | mutex_unlock(&sdata->local->sta_mtx); |
| 2322 | /* ignore frame -- wait for timeout */ |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2323 | } |
| 2324 | |
Calvin Owens | dfa1ad2 | 2014-02-11 12:36:24 -0600 | [diff] [blame] | 2325 | #define case_WLAN(type) \ |
| 2326 | case WLAN_REASON_##type: return #type |
| 2327 | |
| 2328 | static const char *ieee80211_get_reason_code_string(u16 reason_code) |
| 2329 | { |
| 2330 | switch (reason_code) { |
| 2331 | case_WLAN(UNSPECIFIED); |
| 2332 | case_WLAN(PREV_AUTH_NOT_VALID); |
| 2333 | case_WLAN(DEAUTH_LEAVING); |
| 2334 | case_WLAN(DISASSOC_DUE_TO_INACTIVITY); |
| 2335 | case_WLAN(DISASSOC_AP_BUSY); |
| 2336 | case_WLAN(CLASS2_FRAME_FROM_NONAUTH_STA); |
| 2337 | case_WLAN(CLASS3_FRAME_FROM_NONASSOC_STA); |
| 2338 | case_WLAN(DISASSOC_STA_HAS_LEFT); |
| 2339 | case_WLAN(STA_REQ_ASSOC_WITHOUT_AUTH); |
| 2340 | case_WLAN(DISASSOC_BAD_POWER); |
| 2341 | case_WLAN(DISASSOC_BAD_SUPP_CHAN); |
| 2342 | case_WLAN(INVALID_IE); |
| 2343 | case_WLAN(MIC_FAILURE); |
| 2344 | case_WLAN(4WAY_HANDSHAKE_TIMEOUT); |
| 2345 | case_WLAN(GROUP_KEY_HANDSHAKE_TIMEOUT); |
| 2346 | case_WLAN(IE_DIFFERENT); |
| 2347 | case_WLAN(INVALID_GROUP_CIPHER); |
| 2348 | case_WLAN(INVALID_PAIRWISE_CIPHER); |
| 2349 | case_WLAN(INVALID_AKMP); |
| 2350 | case_WLAN(UNSUPP_RSN_VERSION); |
| 2351 | case_WLAN(INVALID_RSN_IE_CAP); |
| 2352 | case_WLAN(IEEE8021X_FAILED); |
| 2353 | case_WLAN(CIPHER_SUITE_REJECTED); |
| 2354 | case_WLAN(DISASSOC_UNSPECIFIED_QOS); |
| 2355 | case_WLAN(DISASSOC_QAP_NO_BANDWIDTH); |
| 2356 | case_WLAN(DISASSOC_LOW_ACK); |
| 2357 | case_WLAN(DISASSOC_QAP_EXCEED_TXOP); |
| 2358 | case_WLAN(QSTA_LEAVE_QBSS); |
| 2359 | case_WLAN(QSTA_NOT_USE); |
| 2360 | case_WLAN(QSTA_REQUIRE_SETUP); |
| 2361 | case_WLAN(QSTA_TIMEOUT); |
| 2362 | case_WLAN(QSTA_CIPHER_NOT_SUPP); |
| 2363 | case_WLAN(MESH_PEER_CANCELED); |
| 2364 | case_WLAN(MESH_MAX_PEERS); |
| 2365 | case_WLAN(MESH_CONFIG); |
| 2366 | case_WLAN(MESH_CLOSE); |
| 2367 | case_WLAN(MESH_MAX_RETRIES); |
| 2368 | case_WLAN(MESH_CONFIRM_TIMEOUT); |
| 2369 | case_WLAN(MESH_INVALID_GTK); |
| 2370 | case_WLAN(MESH_INCONSISTENT_PARAM); |
| 2371 | case_WLAN(MESH_INVALID_SECURITY); |
| 2372 | case_WLAN(MESH_PATH_ERROR); |
| 2373 | case_WLAN(MESH_PATH_NOFORWARD); |
| 2374 | case_WLAN(MESH_PATH_DEST_UNREACHABLE); |
| 2375 | case_WLAN(MAC_EXISTS_IN_MBSS); |
| 2376 | case_WLAN(MESH_CHAN_REGULATORY); |
| 2377 | case_WLAN(MESH_CHAN); |
| 2378 | default: return "<unknown>"; |
| 2379 | } |
| 2380 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2381 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2382 | static void ieee80211_rx_mgmt_deauth(struct ieee80211_sub_if_data *sdata, |
| 2383 | struct ieee80211_mgmt *mgmt, size_t len) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2384 | { |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 2385 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2386 | const u8 *bssid = NULL; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2387 | u16 reason_code; |
| 2388 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2389 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2390 | |
Johannes Berg | f4ea83d | 2008-06-30 15:10:46 +0200 | [diff] [blame] | 2391 | if (len < 24 + 2) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2392 | return; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2393 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2394 | if (!ifmgd->associated || |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2395 | !ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid)) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2396 | return; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2397 | |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 2398 | bssid = ifmgd->associated->bssid; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2399 | |
| 2400 | reason_code = le16_to_cpu(mgmt->u.deauth.reason_code); |
| 2401 | |
Calvin Owens | dfa1ad2 | 2014-02-11 12:36:24 -0600 | [diff] [blame] | 2402 | sdata_info(sdata, "deauthenticated from %pM (Reason: %u=%s)\n", |
| 2403 | bssid, reason_code, ieee80211_get_reason_code_string(reason_code)); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2404 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 2405 | ieee80211_set_disassoc(sdata, 0, 0, false, NULL); |
| 2406 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2407 | cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2408 | } |
| 2409 | |
| 2410 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2411 | static void ieee80211_rx_mgmt_disassoc(struct ieee80211_sub_if_data *sdata, |
| 2412 | struct ieee80211_mgmt *mgmt, size_t len) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2413 | { |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 2414 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2415 | u16 reason_code; |
| 2416 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2417 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2418 | |
Johannes Berg | f4ea83d | 2008-06-30 15:10:46 +0200 | [diff] [blame] | 2419 | if (len < 24 + 2) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2420 | return; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2421 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2422 | if (!ifmgd->associated || |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2423 | !ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid)) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2424 | return; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2425 | |
| 2426 | reason_code = le16_to_cpu(mgmt->u.disassoc.reason_code); |
| 2427 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2428 | sdata_info(sdata, "disassociated from %pM (Reason: %u)\n", |
| 2429 | mgmt->sa, reason_code); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2430 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 2431 | ieee80211_set_disassoc(sdata, 0, 0, false, NULL); |
| 2432 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2433 | cfg80211_rx_mlme_mgmt(sdata->dev, (u8 *)mgmt, len); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2434 | } |
| 2435 | |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2436 | static void ieee80211_get_rates(struct ieee80211_supported_band *sband, |
| 2437 | u8 *supp_rates, unsigned int supp_rates_len, |
| 2438 | u32 *rates, u32 *basic_rates, |
| 2439 | bool *have_higher_than_11mbit, |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 2440 | int *min_rate, int *min_rate_index, |
| 2441 | int shift, u32 rate_flags) |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2442 | { |
| 2443 | int i, j; |
| 2444 | |
| 2445 | for (i = 0; i < supp_rates_len; i++) { |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 2446 | int rate = supp_rates[i] & 0x7f; |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2447 | bool is_basic = !!(supp_rates[i] & 0x80); |
| 2448 | |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 2449 | if ((rate * 5 * (1 << shift)) > 110) |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2450 | *have_higher_than_11mbit = true; |
| 2451 | |
| 2452 | /* |
| 2453 | * BSS_MEMBERSHIP_SELECTOR_HT_PHY is defined in 802.11n-2009 |
| 2454 | * 7.3.2.2 as a magic value instead of a rate. Hence, skip it. |
| 2455 | * |
| 2456 | * Note: Even through the membership selector and the basic |
| 2457 | * rate flag share the same bit, they are not exactly |
| 2458 | * the same. |
| 2459 | */ |
| 2460 | if (!!(supp_rates[i] & 0x80) && |
| 2461 | (supp_rates[i] & 0x7f) == BSS_MEMBERSHIP_SELECTOR_HT_PHY) |
| 2462 | continue; |
| 2463 | |
| 2464 | for (j = 0; j < sband->n_bitrates; j++) { |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 2465 | struct ieee80211_rate *br; |
| 2466 | int brate; |
| 2467 | |
| 2468 | br = &sband->bitrates[j]; |
| 2469 | if ((rate_flags & br->flags) != rate_flags) |
| 2470 | continue; |
| 2471 | |
| 2472 | brate = DIV_ROUND_UP(br->bitrate, (1 << shift) * 5); |
| 2473 | if (brate == rate) { |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2474 | *rates |= BIT(j); |
| 2475 | if (is_basic) |
| 2476 | *basic_rates |= BIT(j); |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 2477 | if ((rate * 5) < *min_rate) { |
| 2478 | *min_rate = rate * 5; |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2479 | *min_rate_index = j; |
| 2480 | } |
| 2481 | break; |
| 2482 | } |
| 2483 | } |
| 2484 | } |
| 2485 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2486 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2487 | static void ieee80211_destroy_assoc_data(struct ieee80211_sub_if_data *sdata, |
| 2488 | bool assoc) |
| 2489 | { |
| 2490 | struct ieee80211_mgd_assoc_data *assoc_data = sdata->u.mgd.assoc_data; |
| 2491 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2492 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2493 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2494 | if (!assoc) { |
| 2495 | sta_info_destroy_addr(sdata, assoc_data->bss->bssid); |
| 2496 | |
| 2497 | memset(sdata->u.mgd.bssid, 0, ETH_ALEN); |
| 2498 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID); |
Johannes Berg | 028e8da0 | 2012-11-26 11:57:41 +0100 | [diff] [blame] | 2499 | sdata->u.mgd.flags = 0; |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2500 | mutex_lock(&sdata->local->mtx); |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2501 | ieee80211_vif_release_channel(sdata); |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 2502 | mutex_unlock(&sdata->local->mtx); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2503 | } |
| 2504 | |
| 2505 | kfree(assoc_data); |
| 2506 | sdata->u.mgd.assoc_data = NULL; |
| 2507 | } |
| 2508 | |
| 2509 | static bool ieee80211_assoc_success(struct ieee80211_sub_if_data *sdata, |
| 2510 | struct cfg80211_bss *cbss, |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2511 | struct ieee80211_mgmt *mgmt, size_t len) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2512 | { |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 2513 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 2514 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 8318d78 | 2008-01-24 19:38:38 +0100 | [diff] [blame] | 2515 | struct ieee80211_supported_band *sband; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2516 | struct sta_info *sta; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2517 | u8 *pos; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2518 | u16 capab_info, aid; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2519 | struct ieee802_11_elems elems; |
Johannes Berg | bda3933 | 2008-10-11 01:51:51 +0200 | [diff] [blame] | 2520 | struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf; |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2521 | const struct cfg80211_bss_ies *bss_ies = NULL; |
| 2522 | struct ieee80211_mgd_assoc_data *assoc_data = ifmgd->assoc_data; |
Johannes Berg | ae5eb02 | 2008-10-14 16:58:37 +0200 | [diff] [blame] | 2523 | u32 changed = 0; |
Christian Lamparter | c74d084 | 2011-10-15 00:14:49 +0200 | [diff] [blame] | 2524 | int err; |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2525 | bool ret; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2526 | |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2527 | /* AssocResp and ReassocResp have identical structure */ |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2528 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2529 | aid = le16_to_cpu(mgmt->u.assoc_resp.aid); |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2530 | capab_info = le16_to_cpu(mgmt->u.assoc_resp.capab_info); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2531 | |
Johannes Berg | 1dd84aa | 2007-10-10 12:03:41 +0200 | [diff] [blame] | 2532 | if ((aid & (BIT(15) | BIT(14))) != (BIT(15) | BIT(14))) |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2533 | sdata_info(sdata, "invalid AID value 0x%x; bits 15:14 not set\n", |
| 2534 | aid); |
Johannes Berg | 1dd84aa | 2007-10-10 12:03:41 +0200 | [diff] [blame] | 2535 | aid &= ~(BIT(15) | BIT(14)); |
| 2536 | |
Johannes Berg | 05cb910 | 2011-10-28 11:59:47 +0200 | [diff] [blame] | 2537 | ifmgd->broken_ap = false; |
| 2538 | |
| 2539 | if (aid == 0 || aid > IEEE80211_MAX_AID) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2540 | sdata_info(sdata, "invalid AID value %d (out of range), turn off PS\n", |
| 2541 | aid); |
Johannes Berg | 05cb910 | 2011-10-28 11:59:47 +0200 | [diff] [blame] | 2542 | aid = 0; |
| 2543 | ifmgd->broken_ap = true; |
| 2544 | } |
| 2545 | |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2546 | pos = mgmt->u.assoc_resp.variable; |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 2547 | ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems); |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2548 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2549 | if (!elems.supp_rates) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2550 | sdata_info(sdata, "no SuppRates element in AssocResp\n"); |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2551 | return false; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2552 | } |
| 2553 | |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 2554 | ifmgd->aid = aid; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2555 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 2556 | /* |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2557 | * Some APs are erroneously not including some information in their |
| 2558 | * (re)association response frames. Try to recover by using the data |
| 2559 | * from the beacon or probe response. This seems to afflict mobile |
| 2560 | * 2G/3G/4G wifi routers, reported models include the "Onda PN51T", |
| 2561 | * "Vodafone PocketWiFi 2", "ZTE MF60" and a similar T-Mobile device. |
| 2562 | */ |
| 2563 | if ((assoc_data->wmm && !elems.wmm_param) || |
| 2564 | (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT) && |
| 2565 | (!elems.ht_cap_elem || !elems.ht_operation)) || |
| 2566 | (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT) && |
| 2567 | (!elems.vht_cap_elem || !elems.vht_operation))) { |
| 2568 | const struct cfg80211_bss_ies *ies; |
| 2569 | struct ieee802_11_elems bss_elems; |
| 2570 | |
| 2571 | rcu_read_lock(); |
| 2572 | ies = rcu_dereference(cbss->ies); |
| 2573 | if (ies) |
| 2574 | bss_ies = kmemdup(ies, sizeof(*ies) + ies->len, |
| 2575 | GFP_ATOMIC); |
| 2576 | rcu_read_unlock(); |
| 2577 | if (!bss_ies) |
| 2578 | return false; |
| 2579 | |
| 2580 | ieee802_11_parse_elems(bss_ies->data, bss_ies->len, |
| 2581 | false, &bss_elems); |
| 2582 | if (assoc_data->wmm && |
| 2583 | !elems.wmm_param && bss_elems.wmm_param) { |
| 2584 | elems.wmm_param = bss_elems.wmm_param; |
| 2585 | sdata_info(sdata, |
| 2586 | "AP bug: WMM param missing from AssocResp\n"); |
| 2587 | } |
| 2588 | |
| 2589 | /* |
| 2590 | * Also check if we requested HT/VHT, otherwise the AP doesn't |
| 2591 | * have to include the IEs in the (re)association response. |
| 2592 | */ |
| 2593 | if (!elems.ht_cap_elem && bss_elems.ht_cap_elem && |
| 2594 | !(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) { |
| 2595 | elems.ht_cap_elem = bss_elems.ht_cap_elem; |
| 2596 | sdata_info(sdata, |
| 2597 | "AP bug: HT capability missing from AssocResp\n"); |
| 2598 | } |
| 2599 | if (!elems.ht_operation && bss_elems.ht_operation && |
| 2600 | !(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) { |
| 2601 | elems.ht_operation = bss_elems.ht_operation; |
| 2602 | sdata_info(sdata, |
| 2603 | "AP bug: HT operation missing from AssocResp\n"); |
| 2604 | } |
| 2605 | if (!elems.vht_cap_elem && bss_elems.vht_cap_elem && |
| 2606 | !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) { |
| 2607 | elems.vht_cap_elem = bss_elems.vht_cap_elem; |
| 2608 | sdata_info(sdata, |
| 2609 | "AP bug: VHT capa missing from AssocResp\n"); |
| 2610 | } |
| 2611 | if (!elems.vht_operation && bss_elems.vht_operation && |
| 2612 | !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) { |
| 2613 | elems.vht_operation = bss_elems.vht_operation; |
| 2614 | sdata_info(sdata, |
| 2615 | "AP bug: VHT operation missing from AssocResp\n"); |
| 2616 | } |
| 2617 | } |
| 2618 | |
| 2619 | /* |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 2620 | * We previously checked these in the beacon/probe response, so |
| 2621 | * they should be present here. This is just a safety net. |
| 2622 | */ |
| 2623 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT) && |
| 2624 | (!elems.wmm_param || !elems.ht_cap_elem || !elems.ht_operation)) { |
| 2625 | sdata_info(sdata, |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2626 | "HT AP is missing WMM params or HT capability/operation\n"); |
| 2627 | ret = false; |
| 2628 | goto out; |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 2629 | } |
| 2630 | |
| 2631 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT) && |
| 2632 | (!elems.vht_cap_elem || !elems.vht_operation)) { |
| 2633 | sdata_info(sdata, |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2634 | "VHT AP is missing VHT capability/operation\n"); |
| 2635 | ret = false; |
| 2636 | goto out; |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 2637 | } |
| 2638 | |
Guy Eilam | 2a33bee | 2011-08-17 15:18:15 +0300 | [diff] [blame] | 2639 | mutex_lock(&sdata->local->sta_mtx); |
| 2640 | /* |
| 2641 | * station info was already allocated and inserted before |
| 2642 | * the association and should be available to us |
| 2643 | */ |
Johannes Berg | 7852e36 | 2012-01-20 13:55:24 +0100 | [diff] [blame] | 2644 | sta = sta_info_get(sdata, cbss->bssid); |
Guy Eilam | 2a33bee | 2011-08-17 15:18:15 +0300 | [diff] [blame] | 2645 | if (WARN_ON(!sta)) { |
| 2646 | mutex_unlock(&sdata->local->sta_mtx); |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2647 | ret = false; |
| 2648 | goto out; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2649 | } |
| 2650 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2651 | sband = local->hw.wiphy->bands[ieee80211_get_sdata_band(sdata)]; |
Johannes Berg | 8318d78 | 2008-01-24 19:38:38 +0100 | [diff] [blame] | 2652 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 2653 | /* Set up internal HT/VHT capabilities */ |
Johannes Berg | a8243b7 | 2012-11-22 14:32:09 +0100 | [diff] [blame] | 2654 | if (elems.ht_cap_elem && !(ifmgd->flags & IEEE80211_STA_DISABLE_HT)) |
Ben Greear | ef96a842 | 2011-11-18 11:32:00 -0800 | [diff] [blame] | 2655 | ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband, |
Johannes Berg | e1a0c6b | 2013-02-07 11:47:44 +0100 | [diff] [blame] | 2656 | elems.ht_cap_elem, sta); |
Johannes Berg | 64f68e5 | 2012-03-28 10:58:37 +0200 | [diff] [blame] | 2657 | |
Mahesh Palivela | 818255e | 2012-10-10 11:33:04 +0000 | [diff] [blame] | 2658 | if (elems.vht_cap_elem && !(ifmgd->flags & IEEE80211_STA_DISABLE_VHT)) |
| 2659 | ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband, |
Johannes Berg | 4a34215 | 2013-02-07 11:58:58 +0100 | [diff] [blame] | 2660 | elems.vht_cap_elem, sta); |
Mahesh Palivela | 818255e | 2012-10-10 11:33:04 +0000 | [diff] [blame] | 2661 | |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 2662 | /* |
| 2663 | * Some APs, e.g. Netgear WNDR3700, report invalid HT operation data |
| 2664 | * in their association response, so ignore that data for our own |
| 2665 | * configuration. If it changed since the last beacon, we'll get the |
| 2666 | * next beacon and update then. |
| 2667 | */ |
Johannes Berg | 1128958 | 2013-02-07 17:36:12 +0100 | [diff] [blame] | 2668 | |
Johannes Berg | bee7f58 | 2013-02-07 22:24:55 +0100 | [diff] [blame] | 2669 | /* |
| 2670 | * If an operating mode notification IE is present, override the |
| 2671 | * NSS calculation (that would be done in rate_control_rate_init()) |
| 2672 | * and use the # of streams from that element. |
| 2673 | */ |
| 2674 | if (elems.opmode_notif && |
| 2675 | !(*elems.opmode_notif & IEEE80211_OPMODE_NOTIF_RX_NSS_TYPE_BF)) { |
| 2676 | u8 nss; |
| 2677 | |
| 2678 | nss = *elems.opmode_notif & IEEE80211_OPMODE_NOTIF_RX_NSS_MASK; |
| 2679 | nss >>= IEEE80211_OPMODE_NOTIF_RX_NSS_SHIFT; |
| 2680 | nss += 1; |
| 2681 | sta->sta.rx_nss = nss; |
| 2682 | } |
| 2683 | |
Johannes Berg | 4b7679a | 2008-09-18 18:14:18 +0200 | [diff] [blame] | 2684 | rate_control_rate_init(sta); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2685 | |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 2686 | if (ifmgd->flags & IEEE80211_STA_MFP_ENABLED) |
Johannes Berg | c2c98fd | 2011-09-29 16:04:36 +0200 | [diff] [blame] | 2687 | set_sta_flag(sta, WLAN_STA_MFP); |
Jouni Malinen | 5394af4 | 2009-01-08 13:31:59 +0200 | [diff] [blame] | 2688 | |
Johannes Berg | a74a8c8 | 2014-07-22 14:50:47 +0200 | [diff] [blame] | 2689 | sta->sta.wme = elems.wmm_param; |
Johannes Berg | ddf4ac5 | 2008-10-22 11:41:38 +0200 | [diff] [blame] | 2690 | |
Johannes Berg | 3e4d40f | 2013-02-07 17:19:08 +0100 | [diff] [blame] | 2691 | err = sta_info_move_state(sta, IEEE80211_STA_ASSOC); |
Johannes Berg | c898787 | 2012-01-20 13:55:17 +0100 | [diff] [blame] | 2692 | if (!err && !(ifmgd->flags & IEEE80211_STA_CONTROL_PORT)) |
| 2693 | err = sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED); |
| 2694 | if (err) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2695 | sdata_info(sdata, |
| 2696 | "failed to move station %pM to desired state\n", |
| 2697 | sta->sta.addr); |
Johannes Berg | c898787 | 2012-01-20 13:55:17 +0100 | [diff] [blame] | 2698 | WARN_ON(__sta_info_destroy(sta)); |
| 2699 | mutex_unlock(&sdata->local->sta_mtx); |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2700 | ret = false; |
| 2701 | goto out; |
Johannes Berg | c898787 | 2012-01-20 13:55:17 +0100 | [diff] [blame] | 2702 | } |
| 2703 | |
Johannes Berg | 7852e36 | 2012-01-20 13:55:24 +0100 | [diff] [blame] | 2704 | mutex_unlock(&sdata->local->sta_mtx); |
Johannes Berg | ddf4ac5 | 2008-10-22 11:41:38 +0200 | [diff] [blame] | 2705 | |
Juuso Oikarinen | f2176d7 | 2010-09-28 14:39:32 +0300 | [diff] [blame] | 2706 | /* |
| 2707 | * Always handle WMM once after association regardless |
| 2708 | * of the first value the AP uses. Setting -1 here has |
| 2709 | * that effect because the AP values is an unsigned |
| 2710 | * 4-bit value. |
| 2711 | */ |
| 2712 | ifmgd->wmm_last_param_set = -1; |
| 2713 | |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 2714 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_WMM) && elems.wmm_param) |
Johannes Berg | 4ced3f7 | 2010-07-19 16:39:04 +0200 | [diff] [blame] | 2715 | ieee80211_sta_wmm_params(local, sdata, elems.wmm_param, |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2716 | elems.wmm_param_len); |
Johannes Berg | aa837e1 | 2009-05-07 16:16:24 +0200 | [diff] [blame] | 2717 | else |
Johannes Berg | 3abead5 | 2012-03-02 15:56:59 +0100 | [diff] [blame] | 2718 | ieee80211_set_wmm_default(sdata, false); |
| 2719 | changed |= BSS_CHANGED_QOS; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2720 | |
Tomas Winkler | 21c0cbe | 2008-03-28 16:33:34 -0700 | [diff] [blame] | 2721 | /* set AID and assoc capability, |
| 2722 | * ieee80211_set_associated() will tell the driver */ |
Johannes Berg | 8318d78 | 2008-01-24 19:38:38 +0100 | [diff] [blame] | 2723 | bss_conf->aid = aid; |
Tomas Winkler | 21c0cbe | 2008-03-28 16:33:34 -0700 | [diff] [blame] | 2724 | bss_conf->assoc_capability = capab_info; |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 2725 | ieee80211_set_associated(sdata, cbss, changed); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2726 | |
Kalle Valo | 15b7b06 | 2009-03-22 21:57:14 +0200 | [diff] [blame] | 2727 | /* |
Felix Fietkau | d524215 | 2010-01-08 18:06:26 +0100 | [diff] [blame] | 2728 | * If we're using 4-addr mode, let the AP know that we're |
| 2729 | * doing so, so that it can create the STA VLAN on its side |
| 2730 | */ |
| 2731 | if (ifmgd->use_4addr) |
| 2732 | ieee80211_send_4addr_nullfunc(local, sdata); |
| 2733 | |
| 2734 | /* |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2735 | * Start timer to probe the connection to the AP now. |
| 2736 | * Also start the timer that will detect beacon loss. |
Kalle Valo | 15b7b06 | 2009-03-22 21:57:14 +0200 | [diff] [blame] | 2737 | */ |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 2738 | ieee80211_sta_rx_notify(sdata, (struct ieee80211_hdr *)mgmt); |
Luis R. Rodriguez | d3a910a | 2010-09-16 15:12:32 -0400 | [diff] [blame] | 2739 | ieee80211_sta_reset_beacon_monitor(sdata); |
Kalle Valo | 15b7b06 | 2009-03-22 21:57:14 +0200 | [diff] [blame] | 2740 | |
Johannes Berg | 35d865a | 2013-05-28 10:54:03 +0200 | [diff] [blame] | 2741 | ret = true; |
| 2742 | out: |
| 2743 | kfree(bss_ies); |
| 2744 | return ret; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2745 | } |
| 2746 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2747 | static void ieee80211_rx_mgmt_assoc_resp(struct ieee80211_sub_if_data *sdata, |
| 2748 | struct ieee80211_mgmt *mgmt, |
| 2749 | size_t len) |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2750 | { |
| 2751 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 2752 | struct ieee80211_mgd_assoc_data *assoc_data = ifmgd->assoc_data; |
| 2753 | u16 capab_info, status_code, aid; |
| 2754 | struct ieee802_11_elems elems; |
| 2755 | u8 *pos; |
| 2756 | bool reassoc; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2757 | struct cfg80211_bss *bss; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2758 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2759 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2760 | |
| 2761 | if (!assoc_data) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2762 | return; |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2763 | if (!ether_addr_equal(assoc_data->bss->bssid, mgmt->bssid)) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2764 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2765 | |
| 2766 | /* |
| 2767 | * AssocResp and ReassocResp have identical structure, so process both |
| 2768 | * of them in this function. |
| 2769 | */ |
| 2770 | |
| 2771 | if (len < 24 + 6) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2772 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2773 | |
| 2774 | reassoc = ieee80211_is_reassoc_req(mgmt->frame_control); |
| 2775 | capab_info = le16_to_cpu(mgmt->u.assoc_resp.capab_info); |
| 2776 | status_code = le16_to_cpu(mgmt->u.assoc_resp.status_code); |
| 2777 | aid = le16_to_cpu(mgmt->u.assoc_resp.aid); |
| 2778 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2779 | sdata_info(sdata, |
| 2780 | "RX %sssocResp from %pM (capab=0x%x status=%d aid=%d)\n", |
| 2781 | reassoc ? "Rea" : "A", mgmt->sa, |
| 2782 | capab_info, status_code, (u16)(aid & ~(BIT(15) | BIT(14)))); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2783 | |
| 2784 | pos = mgmt->u.assoc_resp.variable; |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 2785 | ieee802_11_parse_elems(pos, len - (pos - (u8 *) mgmt), false, &elems); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2786 | |
| 2787 | if (status_code == WLAN_STATUS_ASSOC_REJECTED_TEMPORARILY && |
Johannes Berg | 79ba1d8 | 2013-03-27 14:38:07 +0100 | [diff] [blame] | 2788 | elems.timeout_int && |
| 2789 | elems.timeout_int->type == WLAN_TIMEOUT_ASSOC_COMEBACK) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2790 | u32 tu, ms; |
Johannes Berg | 79ba1d8 | 2013-03-27 14:38:07 +0100 | [diff] [blame] | 2791 | tu = le32_to_cpu(elems.timeout_int->value); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2792 | ms = tu * 1024 / 1000; |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2793 | sdata_info(sdata, |
| 2794 | "%pM rejected association temporarily; comeback duration %u TU (%u ms)\n", |
| 2795 | mgmt->sa, tu, ms); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2796 | assoc_data->timeout = jiffies + msecs_to_jiffies(ms); |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 2797 | assoc_data->timeout_started = true; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2798 | if (ms > IEEE80211_ASSOC_TIMEOUT) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2799 | run_again(sdata, assoc_data->timeout); |
| 2800 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2801 | } |
| 2802 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2803 | bss = assoc_data->bss; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2804 | |
| 2805 | if (status_code != WLAN_STATUS_SUCCESS) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2806 | sdata_info(sdata, "%pM denied association (code=%d)\n", |
| 2807 | mgmt->sa, status_code); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2808 | ieee80211_destroy_assoc_data(sdata, false); |
| 2809 | } else { |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2810 | if (!ieee80211_assoc_success(sdata, bss, mgmt, len)) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2811 | /* oops -- internal error -- send timeout for now */ |
Eliad Peller | 10a9109 | 2012-07-02 14:42:03 +0300 | [diff] [blame] | 2812 | ieee80211_destroy_assoc_data(sdata, false); |
Johannes Berg | 959867f | 2013-06-19 13:05:42 +0200 | [diff] [blame] | 2813 | cfg80211_assoc_timeout(sdata->dev, bss); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2814 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2815 | } |
John W. Linville | 635d999 | 2012-07-09 16:34:34 -0400 | [diff] [blame] | 2816 | sdata_info(sdata, "associated\n"); |
Johannes Berg | 79ebfb8 | 2012-02-20 14:19:58 +0100 | [diff] [blame] | 2817 | |
| 2818 | /* |
| 2819 | * destroy assoc_data afterwards, as otherwise an idle |
| 2820 | * recalc after assoc_data is NULL but before associated |
| 2821 | * is set can cause the interface to go idle |
| 2822 | */ |
| 2823 | ieee80211_destroy_assoc_data(sdata, true); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2824 | } |
| 2825 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 2826 | cfg80211_rx_assoc_resp(sdata->dev, bss, (u8 *)mgmt, len); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2827 | } |
Johannes Berg | 8e3c1b7 | 2012-12-10 13:44:19 +0100 | [diff] [blame] | 2828 | |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 2829 | static void ieee80211_rx_bss_info(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 8e3c1b7 | 2012-12-10 13:44:19 +0100 | [diff] [blame] | 2830 | struct ieee80211_mgmt *mgmt, size_t len, |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2831 | struct ieee80211_rx_status *rx_status, |
Emmanuel Grumbach | d45c417 | 2012-12-10 16:19:13 +0200 | [diff] [blame] | 2832 | struct ieee802_11_elems *elems) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2833 | { |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 2834 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | c2b1345 | 2008-09-11 00:01:55 +0200 | [diff] [blame] | 2835 | struct ieee80211_bss *bss; |
Johannes Berg | fab7d4a | 2008-03-16 18:42:44 +0100 | [diff] [blame] | 2836 | struct ieee80211_channel *channel; |
Johannes Berg | 56007a0 | 2010-01-26 14:19:52 +0100 | [diff] [blame] | 2837 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2838 | sdata_assert_lock(sdata); |
Johannes Berg | b4f286a1 | 2013-03-26 14:13:58 +0100 | [diff] [blame] | 2839 | |
Emmanuel Grumbach | 3afc216 | 2014-03-04 16:50:13 +0200 | [diff] [blame] | 2840 | channel = ieee80211_get_channel(local->hw.wiphy, rx_status->freq); |
| 2841 | if (!channel) |
Johannes Berg | 5bda617 | 2008-09-08 11:05:10 +0200 | [diff] [blame] | 2842 | return; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2843 | |
Johannes Berg | 98c8fcc | 2008-09-08 17:44:26 +0200 | [diff] [blame] | 2844 | bss = ieee80211_bss_info_update(local, rx_status, mgmt, len, elems, |
Emmanuel Grumbach | d45c417 | 2012-12-10 16:19:13 +0200 | [diff] [blame] | 2845 | channel); |
Alexander Bondar | 817cee7 | 2013-05-19 14:23:57 +0300 | [diff] [blame] | 2846 | if (bss) { |
Alexander Bondar | 817cee7 | 2013-05-19 14:23:57 +0300 | [diff] [blame] | 2847 | sdata->vif.bss_conf.beacon_rate = bss->beacon_rate; |
Johannes Berg | d2722f8 | 2014-03-04 11:43:28 +0100 | [diff] [blame] | 2848 | ieee80211_rx_bss_put(local, bss); |
Alexander Bondar | 817cee7 | 2013-05-19 14:23:57 +0300 | [diff] [blame] | 2849 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2850 | } |
| 2851 | |
| 2852 | |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 2853 | static void ieee80211_rx_mgmt_probe_resp(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2854 | struct sk_buff *skb) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2855 | { |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2856 | struct ieee80211_mgmt *mgmt = (void *)skb->data; |
Kalle Valo | 15b7b06 | 2009-03-22 21:57:14 +0200 | [diff] [blame] | 2857 | struct ieee80211_if_managed *ifmgd; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 2858 | struct ieee80211_rx_status *rx_status = (void *) skb->cb; |
| 2859 | size_t baselen, len = skb->len; |
Ester Kummer | ae6a44e | 2008-06-27 18:54:48 +0300 | [diff] [blame] | 2860 | struct ieee802_11_elems elems; |
| 2861 | |
Kalle Valo | 15b7b06 | 2009-03-22 21:57:14 +0200 | [diff] [blame] | 2862 | ifmgd = &sdata->u.mgd; |
| 2863 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2864 | sdata_assert_lock(sdata); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2865 | |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2866 | if (!ether_addr_equal(mgmt->da, sdata->vif.addr)) |
Tomas Winkler | 8e7cdbb | 2008-08-03 14:32:01 +0300 | [diff] [blame] | 2867 | return; /* ignore ProbeResp to foreign address */ |
| 2868 | |
Ester Kummer | ae6a44e | 2008-06-27 18:54:48 +0300 | [diff] [blame] | 2869 | baselen = (u8 *) mgmt->u.probe_resp.variable - (u8 *) mgmt; |
| 2870 | if (baselen > len) |
| 2871 | return; |
| 2872 | |
| 2873 | ieee802_11_parse_elems(mgmt->u.probe_resp.variable, len - baselen, |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 2874 | false, &elems); |
Ester Kummer | ae6a44e | 2008-06-27 18:54:48 +0300 | [diff] [blame] | 2875 | |
Emmanuel Grumbach | d45c417 | 2012-12-10 16:19:13 +0200 | [diff] [blame] | 2876 | ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems); |
Ron Rindjunsky | 9859b81 | 2008-08-09 03:02:19 +0300 | [diff] [blame] | 2877 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2878 | if (ifmgd->associated && |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2879 | ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid)) |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 2880 | ieee80211_reset_ap_probe(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2881 | |
| 2882 | if (ifmgd->auth_data && !ifmgd->auth_data->bss->proberesp_ies && |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2883 | ether_addr_equal(mgmt->bssid, ifmgd->auth_data->bss->bssid)) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2884 | /* got probe response, continue with auth */ |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 2885 | sdata_info(sdata, "direct probe responded\n"); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2886 | ifmgd->auth_data->tries = 0; |
| 2887 | ifmgd->auth_data->timeout = jiffies; |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 2888 | ifmgd->auth_data->timeout_started = true; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2889 | run_again(sdata, ifmgd->auth_data->timeout); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2890 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2891 | } |
| 2892 | |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 2893 | /* |
| 2894 | * This is the canonical list of information elements we care about, |
| 2895 | * the filter code also gives us all changes to the Microsoft OUI |
| 2896 | * (00:50:F2) vendor IE which is used for WMM which we need to track. |
| 2897 | * |
| 2898 | * We implement beacon filtering in software since that means we can |
| 2899 | * avoid processing the frame here and in cfg80211, and userspace |
| 2900 | * will not be able to tell whether the hardware supports it or not. |
| 2901 | * |
| 2902 | * XXX: This list needs to be dynamic -- userspace needs to be able to |
| 2903 | * add items it requires. It also needs to be able to tell us to |
| 2904 | * look out for other vendor IEs. |
| 2905 | */ |
| 2906 | static const u64 care_about_ies = |
Johannes Berg | 1d4df3a | 2009-04-22 11:25:43 +0200 | [diff] [blame] | 2907 | (1ULL << WLAN_EID_COUNTRY) | |
| 2908 | (1ULL << WLAN_EID_ERP_INFO) | |
| 2909 | (1ULL << WLAN_EID_CHANNEL_SWITCH) | |
| 2910 | (1ULL << WLAN_EID_PWR_CONSTRAINT) | |
| 2911 | (1ULL << WLAN_EID_HT_CAPABILITY) | |
Johannes Berg | 074d46d | 2012-03-15 19:45:16 +0100 | [diff] [blame] | 2912 | (1ULL << WLAN_EID_HT_OPERATION); |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 2913 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2914 | static void ieee80211_rx_mgmt_beacon(struct ieee80211_sub_if_data *sdata, |
| 2915 | struct ieee80211_mgmt *mgmt, size_t len, |
| 2916 | struct ieee80211_rx_status *rx_status) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2917 | { |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 2918 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 2919 | struct ieee80211_bss_conf *bss_conf = &sdata->vif.bss_conf; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2920 | size_t baselen; |
| 2921 | struct ieee802_11_elems elems; |
Jasper Bryant-Greene | f698d85 | 2008-08-03 12:04:37 +1200 | [diff] [blame] | 2922 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2923 | struct ieee80211_chanctx_conf *chanctx_conf; |
| 2924 | struct ieee80211_channel *chan; |
Johannes Berg | bee7f58 | 2013-02-07 22:24:55 +0100 | [diff] [blame] | 2925 | struct sta_info *sta; |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 2926 | u32 changed = 0; |
Rami Rosen | f87ad63 | 2012-10-25 10:16:23 +0200 | [diff] [blame] | 2927 | bool erp_valid; |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 2928 | u8 erp_value = 0; |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 2929 | u32 ncrc; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2930 | u8 *bssid; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2931 | u8 deauth_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2932 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2933 | sdata_assert_lock(sdata); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2934 | |
Ester Kummer | ae6a44e | 2008-06-27 18:54:48 +0300 | [diff] [blame] | 2935 | /* Process beacon from the current BSS */ |
| 2936 | baselen = (u8 *) mgmt->u.beacon.variable - (u8 *) mgmt; |
| 2937 | if (baselen > len) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2938 | return; |
Ester Kummer | ae6a44e | 2008-06-27 18:54:48 +0300 | [diff] [blame] | 2939 | |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2940 | rcu_read_lock(); |
| 2941 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 2942 | if (!chanctx_conf) { |
| 2943 | rcu_read_unlock(); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2944 | return; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2945 | } |
| 2946 | |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 2947 | if (rx_status->freq != chanctx_conf->def.chan->center_freq) { |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2948 | rcu_read_unlock(); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2949 | return; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2950 | } |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 2951 | chan = chanctx_conf->def.chan; |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 2952 | rcu_read_unlock(); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 2953 | |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 2954 | if (ifmgd->assoc_data && ifmgd->assoc_data->need_beacon && |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2955 | ether_addr_equal(mgmt->bssid, ifmgd->assoc_data->bss->bssid)) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2956 | ieee802_11_parse_elems(mgmt->u.beacon.variable, |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 2957 | len - baselen, false, &elems); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2958 | |
Emmanuel Grumbach | d45c417 | 2012-12-10 16:19:13 +0200 | [diff] [blame] | 2959 | ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems); |
Alexander Bondar | 482a9c7 | 2013-06-03 17:29:33 +0300 | [diff] [blame] | 2960 | if (elems.tim && !elems.parse_error) { |
| 2961 | const struct ieee80211_tim_ie *tim_ie = elems.tim; |
| 2962 | ifmgd->dtim_period = tim_ie->dtim_period; |
| 2963 | } |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 2964 | ifmgd->have_beacon = true; |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 2965 | ifmgd->assoc_data->need_beacon = false; |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 2966 | if (local->hw.flags & IEEE80211_HW_TIMING_BEACON_ONLY) { |
| 2967 | sdata->vif.bss_conf.sync_tsf = |
| 2968 | le64_to_cpu(mgmt->u.beacon.timestamp); |
| 2969 | sdata->vif.bss_conf.sync_device_ts = |
| 2970 | rx_status->device_timestamp; |
| 2971 | if (elems.tim) |
| 2972 | sdata->vif.bss_conf.sync_dtim_count = |
| 2973 | elems.tim->dtim_count; |
| 2974 | else |
| 2975 | sdata->vif.bss_conf.sync_dtim_count = 0; |
| 2976 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2977 | /* continue assoc process */ |
| 2978 | ifmgd->assoc_data->timeout = jiffies; |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 2979 | ifmgd->assoc_data->timeout_started = true; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2980 | run_again(sdata, ifmgd->assoc_data->timeout); |
| 2981 | return; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 2982 | } |
| 2983 | |
| 2984 | if (!ifmgd->associated || |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 2985 | !ether_addr_equal(mgmt->bssid, ifmgd->associated->bssid)) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 2986 | return; |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 2987 | bssid = ifmgd->associated->bssid; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 2988 | |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 2989 | /* Track average RSSI from the Beacon frames of the current AP */ |
| 2990 | ifmgd->last_beacon_signal = rx_status->signal; |
| 2991 | if (ifmgd->flags & IEEE80211_STA_RESET_SIGNAL_AVE) { |
| 2992 | ifmgd->flags &= ~IEEE80211_STA_RESET_SIGNAL_AVE; |
Jouni Malinen | 3ba06c6 | 2010-08-27 22:21:13 +0300 | [diff] [blame] | 2993 | ifmgd->ave_beacon_signal = rx_status->signal * 16; |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 2994 | ifmgd->last_cqm_event_signal = 0; |
Jouni Malinen | 391a200 | 2010-08-27 22:22:00 +0300 | [diff] [blame] | 2995 | ifmgd->count_beacon_signal = 1; |
Meenakshi Venkataraman | 615f7b9 | 2011-07-08 08:46:22 -0700 | [diff] [blame] | 2996 | ifmgd->last_ave_beacon_signal = 0; |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 2997 | } else { |
| 2998 | ifmgd->ave_beacon_signal = |
| 2999 | (IEEE80211_SIGNAL_AVE_WEIGHT * rx_status->signal * 16 + |
| 3000 | (16 - IEEE80211_SIGNAL_AVE_WEIGHT) * |
| 3001 | ifmgd->ave_beacon_signal) / 16; |
Jouni Malinen | 391a200 | 2010-08-27 22:22:00 +0300 | [diff] [blame] | 3002 | ifmgd->count_beacon_signal++; |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 3003 | } |
Meenakshi Venkataraman | 615f7b9 | 2011-07-08 08:46:22 -0700 | [diff] [blame] | 3004 | |
| 3005 | if (ifmgd->rssi_min_thold != ifmgd->rssi_max_thold && |
| 3006 | ifmgd->count_beacon_signal >= IEEE80211_SIGNAL_AVE_MIN_COUNT) { |
| 3007 | int sig = ifmgd->ave_beacon_signal; |
| 3008 | int last_sig = ifmgd->last_ave_beacon_signal; |
| 3009 | |
| 3010 | /* |
| 3011 | * if signal crosses either of the boundaries, invoke callback |
| 3012 | * with appropriate parameters |
| 3013 | */ |
| 3014 | if (sig > ifmgd->rssi_max_thold && |
| 3015 | (last_sig <= ifmgd->rssi_min_thold || last_sig == 0)) { |
| 3016 | ifmgd->last_ave_beacon_signal = sig; |
Emmanuel Grumbach | 887da91 | 2013-01-20 17:32:41 +0200 | [diff] [blame] | 3017 | drv_rssi_callback(local, sdata, RSSI_EVENT_HIGH); |
Meenakshi Venkataraman | 615f7b9 | 2011-07-08 08:46:22 -0700 | [diff] [blame] | 3018 | } else if (sig < ifmgd->rssi_min_thold && |
| 3019 | (last_sig >= ifmgd->rssi_max_thold || |
| 3020 | last_sig == 0)) { |
| 3021 | ifmgd->last_ave_beacon_signal = sig; |
Emmanuel Grumbach | 887da91 | 2013-01-20 17:32:41 +0200 | [diff] [blame] | 3022 | drv_rssi_callback(local, sdata, RSSI_EVENT_LOW); |
Meenakshi Venkataraman | 615f7b9 | 2011-07-08 08:46:22 -0700 | [diff] [blame] | 3023 | } |
| 3024 | } |
| 3025 | |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 3026 | if (bss_conf->cqm_rssi_thold && |
Jouni Malinen | 391a200 | 2010-08-27 22:22:00 +0300 | [diff] [blame] | 3027 | ifmgd->count_beacon_signal >= IEEE80211_SIGNAL_AVE_MIN_COUNT && |
Johannes Berg | ea08635 | 2012-01-19 09:29:58 +0100 | [diff] [blame] | 3028 | !(sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)) { |
Jouni Malinen | 17e4ec1 | 2010-03-29 23:28:30 -0700 | [diff] [blame] | 3029 | int sig = ifmgd->ave_beacon_signal / 16; |
| 3030 | int last_event = ifmgd->last_cqm_event_signal; |
| 3031 | int thold = bss_conf->cqm_rssi_thold; |
| 3032 | int hyst = bss_conf->cqm_rssi_hyst; |
| 3033 | if (sig < thold && |
| 3034 | (last_event == 0 || sig < last_event - hyst)) { |
| 3035 | ifmgd->last_cqm_event_signal = sig; |
| 3036 | ieee80211_cqm_rssi_notify( |
| 3037 | &sdata->vif, |
| 3038 | NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW, |
| 3039 | GFP_KERNEL); |
| 3040 | } else if (sig > thold && |
| 3041 | (last_event == 0 || sig > last_event + hyst)) { |
| 3042 | ifmgd->last_cqm_event_signal = sig; |
| 3043 | ieee80211_cqm_rssi_notify( |
| 3044 | &sdata->vif, |
| 3045 | NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH, |
| 3046 | GFP_KERNEL); |
| 3047 | } |
| 3048 | } |
| 3049 | |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 3050 | if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3051 | mlme_dbg_ratelimited(sdata, |
Johannes Berg | 112c31f | 2013-02-08 22:59:00 +0100 | [diff] [blame] | 3052 | "cancelling AP probe due to a received beacon\n"); |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 3053 | ieee80211_reset_ap_probe(sdata); |
Jouni Malinen | 9277818 | 2009-05-14 21:15:36 +0300 | [diff] [blame] | 3054 | } |
| 3055 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3056 | /* |
| 3057 | * Push the beacon loss detection into the future since |
| 3058 | * we are processing a beacon from the AP just now. |
| 3059 | */ |
Luis R. Rodriguez | d3a910a | 2010-09-16 15:12:32 -0400 | [diff] [blame] | 3060 | ieee80211_sta_reset_beacon_monitor(sdata); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3061 | |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 3062 | ncrc = crc32_be(0, (void *)&mgmt->u.beacon.beacon_int, 4); |
| 3063 | ncrc = ieee802_11_parse_elems_crc(mgmt->u.beacon.variable, |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 3064 | len - baselen, false, &elems, |
Johannes Berg | d91f36d | 2009-04-16 13:17:26 +0200 | [diff] [blame] | 3065 | care_about_ies, ncrc); |
| 3066 | |
Vivek Natarajan | 25c9c87 | 2009-03-02 20:20:30 +0530 | [diff] [blame] | 3067 | if (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK) { |
Rami Rosen | f87ad63 | 2012-10-25 10:16:23 +0200 | [diff] [blame] | 3068 | bool directed_tim = ieee80211_check_tim(elems.tim, |
| 3069 | elems.tim_len, |
| 3070 | ifmgd->aid); |
Kalle Valo | 1fb3606 | 2009-02-10 17:09:24 +0200 | [diff] [blame] | 3071 | if (directed_tim) { |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 3072 | if (local->hw.conf.dynamic_ps_timeout > 0) { |
Ronald Wahl | 70b12f2 | 2012-03-19 14:37:20 +0100 | [diff] [blame] | 3073 | if (local->hw.conf.flags & IEEE80211_CONF_PS) { |
| 3074 | local->hw.conf.flags &= ~IEEE80211_CONF_PS; |
| 3075 | ieee80211_hw_config(local, |
| 3076 | IEEE80211_CONF_CHANGE_PS); |
| 3077 | } |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 3078 | ieee80211_send_nullfunc(local, sdata, 0); |
Rajkumar Manoharan | 6f0756a | 2012-03-15 05:50:36 +0530 | [diff] [blame] | 3079 | } else if (!local->pspolling && sdata->u.mgd.powersave) { |
Kalle Valo | 572e001 | 2009-02-10 17:09:31 +0200 | [diff] [blame] | 3080 | local->pspolling = true; |
| 3081 | |
| 3082 | /* |
| 3083 | * Here is assumed that the driver will be |
| 3084 | * able to send ps-poll frame and receive a |
| 3085 | * response even though power save mode is |
| 3086 | * enabled, but some drivers might require |
| 3087 | * to disable power save here. This needs |
| 3088 | * to be investigated. |
| 3089 | */ |
| 3090 | ieee80211_send_pspoll(local, sdata); |
| 3091 | } |
Vivek Natarajan | a97b77b | 2008-12-23 18:39:02 -0800 | [diff] [blame] | 3092 | } |
| 3093 | } |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 3094 | |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 3095 | if (sdata->vif.p2p) { |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 3096 | struct ieee80211_p2p_noa_attr noa = {}; |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 3097 | int ret; |
| 3098 | |
| 3099 | ret = cfg80211_get_p2p_attr(mgmt->u.beacon.variable, |
| 3100 | len - baselen, |
| 3101 | IEEE80211_P2P_ATTR_ABSENCE_NOTICE, |
Janusz Dziedzic | 934457e | 2013-03-21 15:47:55 +0100 | [diff] [blame] | 3102 | (u8 *) &noa, sizeof(noa)); |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 3103 | if (ret >= 2) { |
| 3104 | if (sdata->u.mgd.p2p_noa_index != noa.index) { |
| 3105 | /* valid noa_attr and index changed */ |
| 3106 | sdata->u.mgd.p2p_noa_index = noa.index; |
| 3107 | memcpy(&bss_conf->p2p_noa_attr, &noa, sizeof(noa)); |
| 3108 | changed |= BSS_CHANGED_P2P_PS; |
| 3109 | /* |
| 3110 | * make sure we update all information, the CRC |
| 3111 | * mechanism doesn't look at P2P attributes. |
| 3112 | */ |
| 3113 | ifmgd->beacon_crc_valid = false; |
| 3114 | } |
| 3115 | } else if (sdata->u.mgd.p2p_noa_index != -1) { |
| 3116 | /* noa_attr not found and we had valid noa_attr before */ |
| 3117 | sdata->u.mgd.p2p_noa_index = -1; |
| 3118 | memset(&bss_conf->p2p_noa_attr, 0, sizeof(bss_conf->p2p_noa_attr)); |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 3119 | changed |= BSS_CHANGED_P2P_PS; |
Johannes Berg | 488dd7b | 2012-10-29 20:08:01 +0100 | [diff] [blame] | 3120 | ifmgd->beacon_crc_valid = false; |
| 3121 | } |
| 3122 | } |
| 3123 | |
Juuso Oikarinen | d8ec443 | 2010-10-01 16:02:31 +0300 | [diff] [blame] | 3124 | if (ncrc == ifmgd->beacon_crc && ifmgd->beacon_crc_valid) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3125 | return; |
Jouni Malinen | 3019667 | 2009-05-19 17:01:43 +0300 | [diff] [blame] | 3126 | ifmgd->beacon_crc = ncrc; |
Juuso Oikarinen | d8ec443 | 2010-10-01 16:02:31 +0300 | [diff] [blame] | 3127 | ifmgd->beacon_crc_valid = true; |
Jouni Malinen | 3019667 | 2009-05-19 17:01:43 +0300 | [diff] [blame] | 3128 | |
Emmanuel Grumbach | d45c417 | 2012-12-10 16:19:13 +0200 | [diff] [blame] | 3129 | ieee80211_rx_bss_info(sdata, mgmt, len, rx_status, &elems); |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 3130 | |
Johannes Berg | d70b761 | 2013-08-23 15:48:48 +0200 | [diff] [blame] | 3131 | ieee80211_sta_process_chanswitch(sdata, rx_status->mactime, |
| 3132 | &elems, true); |
| 3133 | |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 3134 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_WMM) && |
| 3135 | ieee80211_sta_wmm_params(local, sdata, elems.wmm_param, |
Johannes Berg | 7d25745 | 2012-07-06 17:37:43 +0200 | [diff] [blame] | 3136 | elems.wmm_param_len)) |
| 3137 | changed |= BSS_CHANGED_QOS; |
| 3138 | |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 3139 | /* |
| 3140 | * If we haven't had a beacon before, tell the driver about the |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 3141 | * DTIM period (and beacon timing if desired) now. |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 3142 | */ |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 3143 | if (!ifmgd->have_beacon) { |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 3144 | /* a few bogus AP send dtim_period = 0 or no TIM IE */ |
| 3145 | if (elems.tim) |
| 3146 | bss_conf->dtim_period = elems.tim->dtim_period ?: 1; |
| 3147 | else |
| 3148 | bss_conf->dtim_period = 1; |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 3149 | |
| 3150 | if (local->hw.flags & IEEE80211_HW_TIMING_BEACON_ONLY) { |
| 3151 | sdata->vif.bss_conf.sync_tsf = |
| 3152 | le64_to_cpu(mgmt->u.beacon.timestamp); |
| 3153 | sdata->vif.bss_conf.sync_device_ts = |
| 3154 | rx_status->device_timestamp; |
| 3155 | if (elems.tim) |
| 3156 | sdata->vif.bss_conf.sync_dtim_count = |
| 3157 | elems.tim->dtim_count; |
| 3158 | else |
| 3159 | sdata->vif.bss_conf.sync_dtim_count = 0; |
| 3160 | } |
| 3161 | |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 3162 | changed |= BSS_CHANGED_BEACON_INFO; |
| 3163 | ifmgd->have_beacon = true; |
Alexander Bondar | 482a9c7 | 2013-06-03 17:29:33 +0300 | [diff] [blame] | 3164 | |
| 3165 | mutex_lock(&local->iflist_mtx); |
| 3166 | ieee80211_recalc_ps(local, -1); |
| 3167 | mutex_unlock(&local->iflist_mtx); |
| 3168 | |
Alexander Bondar | ce85788 | 2013-05-06 17:17:04 +0300 | [diff] [blame] | 3169 | ieee80211_recalc_ps_vif(sdata); |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 3170 | } |
| 3171 | |
Johannes Berg | 1946bed | 2013-03-27 14:31:53 +0100 | [diff] [blame] | 3172 | if (elems.erp_info) { |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 3173 | erp_valid = true; |
| 3174 | erp_value = elems.erp_info[0]; |
| 3175 | } else { |
| 3176 | erp_valid = false; |
John W. Linville | 50c4afb | 2008-04-15 14:09:27 -0400 | [diff] [blame] | 3177 | } |
Johannes Berg | 7a5158e | 2008-10-08 10:59:33 +0200 | [diff] [blame] | 3178 | changed |= ieee80211_handle_bss_capability(sdata, |
| 3179 | le16_to_cpu(mgmt->u.beacon.capab_info), |
| 3180 | erp_valid, erp_value); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3181 | |
Johannes Berg | 1128958 | 2013-02-07 17:36:12 +0100 | [diff] [blame] | 3182 | mutex_lock(&local->sta_mtx); |
Johannes Berg | bee7f58 | 2013-02-07 22:24:55 +0100 | [diff] [blame] | 3183 | sta = sta_info_get(sdata, bssid); |
| 3184 | |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 3185 | if (ieee80211_config_bw(sdata, sta, |
| 3186 | elems.ht_cap_elem, elems.ht_operation, |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 3187 | elems.vht_operation, bssid, &changed)) { |
| 3188 | mutex_unlock(&local->sta_mtx); |
| 3189 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, |
| 3190 | WLAN_REASON_DEAUTH_LEAVING, |
| 3191 | true, deauth_buf); |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 3192 | cfg80211_tx_mlme_mgmt(sdata->dev, deauth_buf, |
| 3193 | sizeof(deauth_buf)); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3194 | return; |
Johannes Berg | 30eb1dc | 2013-02-08 15:12:14 +0100 | [diff] [blame] | 3195 | } |
Johannes Berg | bee7f58 | 2013-02-07 22:24:55 +0100 | [diff] [blame] | 3196 | |
| 3197 | if (sta && elems.opmode_notif) |
| 3198 | ieee80211_vht_handle_opmode(sdata, sta, *elems.opmode_notif, |
| 3199 | rx_status->band, true); |
Johannes Berg | 1128958 | 2013-02-07 17:36:12 +0100 | [diff] [blame] | 3200 | mutex_unlock(&local->sta_mtx); |
Ron Rindjunsky | d3c990f | 2007-11-26 16:14:34 +0200 | [diff] [blame] | 3201 | |
Johannes Berg | 04b7b2f | 2012-09-05 13:41:37 +0200 | [diff] [blame] | 3202 | if (elems.country_elem && elems.pwr_constr_elem && |
| 3203 | mgmt->u.probe_resp.capab_info & |
| 3204 | cpu_to_le16(WLAN_CAPABILITY_SPECTRUM_MGMT)) |
Johannes Berg | 1ea6f9c | 2012-10-24 10:59:25 +0200 | [diff] [blame] | 3205 | changed |= ieee80211_handle_pwr_constr(sdata, chan, |
| 3206 | elems.country_elem, |
| 3207 | elems.country_elem_len, |
| 3208 | elems.pwr_constr_elem); |
Luis R. Rodriguez | 3f2355c | 2008-11-12 14:22:02 -0800 | [diff] [blame] | 3209 | |
Johannes Berg | 471b3ef | 2007-12-28 14:32:58 +0100 | [diff] [blame] | 3210 | ieee80211_bss_info_change_notify(sdata, changed); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3211 | } |
| 3212 | |
Johannes Berg | 1fa57d0 | 2010-06-10 10:21:32 +0200 | [diff] [blame] | 3213 | void ieee80211_sta_rx_queued_mgmt(struct ieee80211_sub_if_data *sdata, |
| 3214 | struct sk_buff *skb) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3215 | { |
| 3216 | struct ieee80211_rx_status *rx_status; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3217 | struct ieee80211_mgmt *mgmt; |
| 3218 | u16 fc; |
Johannes Berg | 1b3a2e4 | 2013-03-26 15:17:18 +0100 | [diff] [blame] | 3219 | struct ieee802_11_elems elems; |
| 3220 | int ies_len; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3221 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3222 | rx_status = (struct ieee80211_rx_status *) skb->cb; |
| 3223 | mgmt = (struct ieee80211_mgmt *) skb->data; |
| 3224 | fc = le16_to_cpu(mgmt->frame_control); |
| 3225 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3226 | sdata_lock(sdata); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 3227 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3228 | switch (fc & IEEE80211_FCTL_STYPE) { |
| 3229 | case IEEE80211_STYPE_BEACON: |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3230 | ieee80211_rx_mgmt_beacon(sdata, mgmt, skb->len, rx_status); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3231 | break; |
| 3232 | case IEEE80211_STYPE_PROBE_RESP: |
| 3233 | ieee80211_rx_mgmt_probe_resp(sdata, skb); |
| 3234 | break; |
| 3235 | case IEEE80211_STYPE_AUTH: |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3236 | ieee80211_rx_mgmt_auth(sdata, mgmt, skb->len); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3237 | break; |
| 3238 | case IEEE80211_STYPE_DEAUTH: |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3239 | ieee80211_rx_mgmt_deauth(sdata, mgmt, skb->len); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3240 | break; |
| 3241 | case IEEE80211_STYPE_DISASSOC: |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3242 | ieee80211_rx_mgmt_disassoc(sdata, mgmt, skb->len); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3243 | break; |
| 3244 | case IEEE80211_STYPE_ASSOC_RESP: |
| 3245 | case IEEE80211_STYPE_REASSOC_RESP: |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3246 | ieee80211_rx_mgmt_assoc_resp(sdata, mgmt, skb->len); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3247 | break; |
| 3248 | case IEEE80211_STYPE_ACTION: |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 3249 | if (mgmt->u.action.category == WLAN_CATEGORY_SPECTRUM_MGMT) { |
Johannes Berg | 1b3a2e4 | 2013-03-26 15:17:18 +0100 | [diff] [blame] | 3250 | ies_len = skb->len - |
| 3251 | offsetof(struct ieee80211_mgmt, |
| 3252 | u.action.u.chan_switch.variable); |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 3253 | |
| 3254 | if (ies_len < 0) |
| 3255 | break; |
| 3256 | |
| 3257 | ieee802_11_parse_elems( |
| 3258 | mgmt->u.action.u.chan_switch.variable, |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 3259 | ies_len, true, &elems); |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 3260 | |
| 3261 | if (elems.parse_error) |
| 3262 | break; |
| 3263 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3264 | ieee80211_sta_process_chanswitch(sdata, |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 3265 | rx_status->mactime, |
Johannes Berg | 04a161f | 2013-05-03 09:35:35 +0200 | [diff] [blame] | 3266 | &elems, false); |
Johannes Berg | 1b3a2e4 | 2013-03-26 15:17:18 +0100 | [diff] [blame] | 3267 | } else if (mgmt->u.action.category == WLAN_CATEGORY_PUBLIC) { |
| 3268 | ies_len = skb->len - |
| 3269 | offsetof(struct ieee80211_mgmt, |
| 3270 | u.action.u.ext_chan_switch.variable); |
| 3271 | |
| 3272 | if (ies_len < 0) |
| 3273 | break; |
| 3274 | |
| 3275 | ieee802_11_parse_elems( |
| 3276 | mgmt->u.action.u.ext_chan_switch.variable, |
Johannes Berg | b2e506b | 2013-03-26 14:54:16 +0100 | [diff] [blame] | 3277 | ies_len, true, &elems); |
Johannes Berg | 1b3a2e4 | 2013-03-26 15:17:18 +0100 | [diff] [blame] | 3278 | |
| 3279 | if (elems.parse_error) |
| 3280 | break; |
| 3281 | |
| 3282 | /* for the handling code pretend this was also an IE */ |
| 3283 | elems.ext_chansw_ie = |
| 3284 | &mgmt->u.action.u.ext_chan_switch.data; |
| 3285 | |
| 3286 | ieee80211_sta_process_chanswitch(sdata, |
| 3287 | rx_status->mactime, |
Johannes Berg | 04a161f | 2013-05-03 09:35:35 +0200 | [diff] [blame] | 3288 | &elems, false); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 3289 | } |
Johannes Berg | 37799e5 | 2013-03-26 14:02:26 +0100 | [diff] [blame] | 3290 | break; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 3291 | } |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3292 | sdata_unlock(sdata); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3293 | } |
| 3294 | |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 3295 | static void ieee80211_sta_timer(unsigned long data) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3296 | { |
| 3297 | struct ieee80211_sub_if_data *sdata = |
| 3298 | (struct ieee80211_sub_if_data *) data; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3299 | |
Stanislaw Gruszka | 9b7d72c | 2013-02-28 10:55:27 +0100 | [diff] [blame] | 3300 | ieee80211_queue_work(&sdata->local->hw, &sdata->work); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 3301 | } |
| 3302 | |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3303 | static void ieee80211_sta_connection_lost(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 6b684db | 2013-01-29 11:35:29 +0100 | [diff] [blame] | 3304 | u8 *bssid, u8 reason, bool tx) |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3305 | { |
Antonio Quartulli | 6ae1677 | 2012-09-07 13:28:52 +0200 | [diff] [blame] | 3306 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3307 | |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 3308 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, reason, |
Johannes Berg | 6b684db | 2013-01-29 11:35:29 +0100 | [diff] [blame] | 3309 | tx, frame_buf); |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 3310 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 3311 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 3312 | IEEE80211_DEAUTH_FRAME_LEN); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3313 | } |
| 3314 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3315 | static int ieee80211_probe_auth(struct ieee80211_sub_if_data *sdata) |
| 3316 | { |
| 3317 | struct ieee80211_local *local = sdata->local; |
| 3318 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3319 | struct ieee80211_mgd_auth_data *auth_data = ifmgd->auth_data; |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3320 | u32 tx_flags = 0; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3321 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3322 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3323 | |
| 3324 | if (WARN_ON_ONCE(!auth_data)) |
| 3325 | return -EINVAL; |
| 3326 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3327 | auth_data->tries++; |
| 3328 | |
| 3329 | if (auth_data->tries > IEEE80211_AUTH_MAX_TRIES) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3330 | sdata_info(sdata, "authentication with %pM timed out\n", |
| 3331 | auth_data->bss->bssid); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3332 | |
| 3333 | /* |
| 3334 | * Most likely AP is not in the range so remove the |
| 3335 | * bss struct for that AP. |
| 3336 | */ |
| 3337 | cfg80211_unlink_bss(local->hw.wiphy, auth_data->bss); |
| 3338 | |
| 3339 | return -ETIMEDOUT; |
| 3340 | } |
| 3341 | |
Johannes Berg | a1845fc | 2012-06-27 13:18:36 +0200 | [diff] [blame] | 3342 | drv_mgd_prepare_tx(local, sdata); |
| 3343 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3344 | if (auth_data->bss->proberesp_ies) { |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 3345 | u16 trans = 1; |
| 3346 | u16 status = 0; |
| 3347 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3348 | sdata_info(sdata, "send auth to %pM (try %d/%d)\n", |
| 3349 | auth_data->bss->bssid, auth_data->tries, |
| 3350 | IEEE80211_AUTH_MAX_TRIES); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3351 | |
| 3352 | auth_data->expected_transaction = 2; |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 3353 | |
| 3354 | if (auth_data->algorithm == WLAN_AUTH_SAE) { |
| 3355 | trans = auth_data->sae_trans; |
| 3356 | status = auth_data->sae_status; |
| 3357 | auth_data->expected_transaction = trans; |
| 3358 | } |
| 3359 | |
Stanislaw Gruszka | 6211dd1 | 2013-05-17 13:43:04 +0200 | [diff] [blame] | 3360 | if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) |
| 3361 | tx_flags = IEEE80211_TX_CTL_REQ_TX_STATUS | |
| 3362 | IEEE80211_TX_INTFL_MLME_CONN_TX; |
| 3363 | |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 3364 | ieee80211_send_auth(sdata, trans, auth_data->algorithm, status, |
| 3365 | auth_data->data, auth_data->data_len, |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3366 | auth_data->bss->bssid, |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3367 | auth_data->bss->bssid, NULL, 0, 0, |
| 3368 | tx_flags); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3369 | } else { |
| 3370 | const u8 *ssidie; |
| 3371 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3372 | sdata_info(sdata, "direct probe to %pM (try %d/%i)\n", |
| 3373 | auth_data->bss->bssid, auth_data->tries, |
| 3374 | IEEE80211_AUTH_MAX_TRIES); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3375 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3376 | rcu_read_lock(); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3377 | ssidie = ieee80211_bss_get_ie(auth_data->bss, WLAN_EID_SSID); |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3378 | if (!ssidie) { |
| 3379 | rcu_read_unlock(); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3380 | return -EINVAL; |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3381 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3382 | /* |
| 3383 | * Direct probe is sent to broadcast address as some APs |
| 3384 | * will not answer to direct packet in unassociated state. |
| 3385 | */ |
| 3386 | ieee80211_send_probe_req(sdata, NULL, ssidie + 2, ssidie[1], |
Stanislaw Gruszka | 6211dd1 | 2013-05-17 13:43:04 +0200 | [diff] [blame] | 3387 | NULL, 0, (u32) -1, true, 0, |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3388 | auth_data->bss->channel, false); |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3389 | rcu_read_unlock(); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3390 | } |
| 3391 | |
Stanislaw Gruszka | 6211dd1 | 2013-05-17 13:43:04 +0200 | [diff] [blame] | 3392 | if (tx_flags == 0) { |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3393 | auth_data->timeout = jiffies + IEEE80211_AUTH_TIMEOUT; |
Johannes Berg | cb236d2 | 2013-07-29 23:07:43 +0200 | [diff] [blame] | 3394 | auth_data->timeout_started = true; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3395 | run_again(sdata, auth_data->timeout); |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3396 | } else { |
Johannes Berg | cb236d2 | 2013-07-29 23:07:43 +0200 | [diff] [blame] | 3397 | auth_data->timeout = |
| 3398 | round_jiffies_up(jiffies + IEEE80211_AUTH_TIMEOUT_LONG); |
| 3399 | auth_data->timeout_started = true; |
| 3400 | run_again(sdata, auth_data->timeout); |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3401 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3402 | |
| 3403 | return 0; |
| 3404 | } |
| 3405 | |
| 3406 | static int ieee80211_do_assoc(struct ieee80211_sub_if_data *sdata) |
| 3407 | { |
| 3408 | struct ieee80211_mgd_assoc_data *assoc_data = sdata->u.mgd.assoc_data; |
| 3409 | struct ieee80211_local *local = sdata->local; |
| 3410 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3411 | sdata_assert_lock(sdata); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3412 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3413 | assoc_data->tries++; |
| 3414 | if (assoc_data->tries > IEEE80211_ASSOC_MAX_TRIES) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3415 | sdata_info(sdata, "association with %pM timed out\n", |
| 3416 | assoc_data->bss->bssid); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3417 | |
| 3418 | /* |
| 3419 | * Most likely AP is not in the range so remove the |
| 3420 | * bss struct for that AP. |
| 3421 | */ |
| 3422 | cfg80211_unlink_bss(local->hw.wiphy, assoc_data->bss); |
| 3423 | |
| 3424 | return -ETIMEDOUT; |
| 3425 | } |
| 3426 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3427 | sdata_info(sdata, "associate with %pM (try %d/%d)\n", |
| 3428 | assoc_data->bss->bssid, assoc_data->tries, |
| 3429 | IEEE80211_ASSOC_MAX_TRIES); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3430 | ieee80211_send_assoc(sdata); |
| 3431 | |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3432 | if (!(local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS)) { |
| 3433 | assoc_data->timeout = jiffies + IEEE80211_ASSOC_TIMEOUT; |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3434 | assoc_data->timeout_started = true; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3435 | run_again(sdata, assoc_data->timeout); |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3436 | } else { |
Johannes Berg | cb236d2 | 2013-07-29 23:07:43 +0200 | [diff] [blame] | 3437 | assoc_data->timeout = |
| 3438 | round_jiffies_up(jiffies + |
| 3439 | IEEE80211_ASSOC_TIMEOUT_LONG); |
| 3440 | assoc_data->timeout_started = true; |
| 3441 | run_again(sdata, assoc_data->timeout); |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3442 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3443 | |
| 3444 | return 0; |
| 3445 | } |
| 3446 | |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3447 | void ieee80211_mgd_conn_tx_status(struct ieee80211_sub_if_data *sdata, |
| 3448 | __le16 fc, bool acked) |
| 3449 | { |
| 3450 | struct ieee80211_local *local = sdata->local; |
| 3451 | |
| 3452 | sdata->u.mgd.status_fc = fc; |
| 3453 | sdata->u.mgd.status_acked = acked; |
| 3454 | sdata->u.mgd.status_received = true; |
| 3455 | |
| 3456 | ieee80211_queue_work(&local->hw, &sdata->work); |
| 3457 | } |
| 3458 | |
Johannes Berg | 1fa57d0 | 2010-06-10 10:21:32 +0200 | [diff] [blame] | 3459 | void ieee80211_sta_work(struct ieee80211_sub_if_data *sdata) |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 3460 | { |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 3461 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 1fa57d0 | 2010-06-10 10:21:32 +0200 | [diff] [blame] | 3462 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 3463 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3464 | sdata_lock(sdata); |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 3465 | |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3466 | if (ifmgd->status_received) { |
| 3467 | __le16 fc = ifmgd->status_fc; |
| 3468 | bool status_acked = ifmgd->status_acked; |
| 3469 | |
| 3470 | ifmgd->status_received = false; |
| 3471 | if (ifmgd->auth_data && |
| 3472 | (ieee80211_is_probe_req(fc) || ieee80211_is_auth(fc))) { |
| 3473 | if (status_acked) { |
| 3474 | ifmgd->auth_data->timeout = |
| 3475 | jiffies + IEEE80211_AUTH_TIMEOUT_SHORT; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3476 | run_again(sdata, ifmgd->auth_data->timeout); |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3477 | } else { |
| 3478 | ifmgd->auth_data->timeout = jiffies - 1; |
| 3479 | } |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3480 | ifmgd->auth_data->timeout_started = true; |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3481 | } else if (ifmgd->assoc_data && |
| 3482 | (ieee80211_is_assoc_req(fc) || |
| 3483 | ieee80211_is_reassoc_req(fc))) { |
| 3484 | if (status_acked) { |
| 3485 | ifmgd->assoc_data->timeout = |
| 3486 | jiffies + IEEE80211_ASSOC_TIMEOUT_SHORT; |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3487 | run_again(sdata, ifmgd->assoc_data->timeout); |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3488 | } else { |
| 3489 | ifmgd->assoc_data->timeout = jiffies - 1; |
| 3490 | } |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3491 | ifmgd->assoc_data->timeout_started = true; |
Johannes Berg | 1672c0e3 | 2013-01-29 15:02:27 +0100 | [diff] [blame] | 3492 | } |
| 3493 | } |
| 3494 | |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3495 | if (ifmgd->auth_data && ifmgd->auth_data->timeout_started && |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3496 | time_after(jiffies, ifmgd->auth_data->timeout)) { |
| 3497 | if (ifmgd->auth_data->done) { |
| 3498 | /* |
| 3499 | * ok ... we waited for assoc but userspace didn't, |
| 3500 | * so let's just kill the auth data |
| 3501 | */ |
| 3502 | ieee80211_destroy_auth_data(sdata, false); |
| 3503 | } else if (ieee80211_probe_auth(sdata)) { |
| 3504 | u8 bssid[ETH_ALEN]; |
| 3505 | |
| 3506 | memcpy(bssid, ifmgd->auth_data->bss->bssid, ETH_ALEN); |
| 3507 | |
| 3508 | ieee80211_destroy_auth_data(sdata, false); |
| 3509 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 3510 | cfg80211_auth_timeout(sdata->dev, bssid); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3511 | } |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3512 | } else if (ifmgd->auth_data && ifmgd->auth_data->timeout_started) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3513 | run_again(sdata, ifmgd->auth_data->timeout); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3514 | |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3515 | if (ifmgd->assoc_data && ifmgd->assoc_data->timeout_started && |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3516 | time_after(jiffies, ifmgd->assoc_data->timeout)) { |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 3517 | if ((ifmgd->assoc_data->need_beacon && !ifmgd->have_beacon) || |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3518 | ieee80211_do_assoc(sdata)) { |
Johannes Berg | 959867f | 2013-06-19 13:05:42 +0200 | [diff] [blame] | 3519 | struct cfg80211_bss *bss = ifmgd->assoc_data->bss; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3520 | |
| 3521 | ieee80211_destroy_assoc_data(sdata, false); |
Johannes Berg | 959867f | 2013-06-19 13:05:42 +0200 | [diff] [blame] | 3522 | cfg80211_assoc_timeout(sdata->dev, bss); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3523 | } |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 3524 | } else if (ifmgd->assoc_data && ifmgd->assoc_data->timeout_started) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3525 | run_again(sdata, ifmgd->assoc_data->timeout); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 3526 | |
Stanislaw Gruszka | 392b9ff | 2013-08-27 11:36:35 +0200 | [diff] [blame] | 3527 | if (ifmgd->flags & IEEE80211_STA_CONNECTION_POLL && |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3528 | ifmgd->associated) { |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 3529 | u8 bssid[ETH_ALEN]; |
Felix Fietkau | 72a8a3e | 2010-11-23 03:10:32 +0100 | [diff] [blame] | 3530 | int max_tries; |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 3531 | |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 3532 | memcpy(bssid, ifmgd->associated->bssid, ETH_ALEN); |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 3533 | |
Felix Fietkau | 72a8a3e | 2010-11-23 03:10:32 +0100 | [diff] [blame] | 3534 | if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 3535 | max_tries = max_nullfunc_tries; |
Felix Fietkau | 72a8a3e | 2010-11-23 03:10:32 +0100 | [diff] [blame] | 3536 | else |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 3537 | max_tries = max_probe_tries; |
Felix Fietkau | 72a8a3e | 2010-11-23 03:10:32 +0100 | [diff] [blame] | 3538 | |
Felix Fietkau | 4e5ff37 | 2010-11-23 03:10:31 +0100 | [diff] [blame] | 3539 | /* ACK received for nullfunc probing frame */ |
| 3540 | if (!ifmgd->probe_send_count) |
| 3541 | ieee80211_reset_ap_probe(sdata); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3542 | else if (ifmgd->nullfunc_failed) { |
| 3543 | if (ifmgd->probe_send_count < max_tries) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3544 | mlme_dbg(sdata, |
| 3545 | "No ack for nullfunc frame to AP %pM, try %d/%i\n", |
| 3546 | bssid, ifmgd->probe_send_count, |
| 3547 | max_tries); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3548 | ieee80211_mgd_probe_ap_send(sdata); |
| 3549 | } else { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3550 | mlme_dbg(sdata, |
| 3551 | "No ack for nullfunc frame to AP %pM, disconnecting.\n", |
| 3552 | bssid); |
Johannes Berg | 95acac6 | 2011-07-12 12:30:59 +0200 | [diff] [blame] | 3553 | ieee80211_sta_connection_lost(sdata, bssid, |
Johannes Berg | 6b684db | 2013-01-29 11:35:29 +0100 | [diff] [blame] | 3554 | WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY, |
| 3555 | false); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3556 | } |
| 3557 | } else if (time_is_after_jiffies(ifmgd->probe_timeout)) |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3558 | run_again(sdata, ifmgd->probe_timeout); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3559 | else if (local->hw.flags & IEEE80211_HW_REPORTS_TX_ACK_STATUS) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3560 | mlme_dbg(sdata, |
| 3561 | "Failed to send nullfunc to AP %pM after %dms, disconnecting\n", |
| 3562 | bssid, probe_wait_ms); |
Johannes Berg | 95acac6 | 2011-07-12 12:30:59 +0200 | [diff] [blame] | 3563 | ieee80211_sta_connection_lost(sdata, bssid, |
Johannes Berg | 6b684db | 2013-01-29 11:35:29 +0100 | [diff] [blame] | 3564 | WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY, false); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3565 | } else if (ifmgd->probe_send_count < max_tries) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3566 | mlme_dbg(sdata, |
| 3567 | "No probe response from AP %pM after %dms, try %d/%i\n", |
| 3568 | bssid, probe_wait_ms, |
| 3569 | ifmgd->probe_send_count, max_tries); |
Maxim Levitsky | a43abf2 | 2009-07-31 18:54:12 +0300 | [diff] [blame] | 3570 | ieee80211_mgd_probe_ap_send(sdata); |
| 3571 | } else { |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3572 | /* |
| 3573 | * We actually lost the connection ... or did we? |
| 3574 | * Let's make sure! |
| 3575 | */ |
Ben Greear | b38afa8 | 2010-10-07 16:12:06 -0700 | [diff] [blame] | 3576 | wiphy_debug(local->hw.wiphy, |
| 3577 | "%s: No probe response from AP %pM" |
| 3578 | " after %dms, disconnecting.\n", |
| 3579 | sdata->name, |
Ben Greear | 180205b | 2011-02-04 15:30:24 -0800 | [diff] [blame] | 3580 | bssid, probe_wait_ms); |
Felix Fietkau | 04ac3c0 | 2010-12-02 21:01:08 +0100 | [diff] [blame] | 3581 | |
Johannes Berg | 95acac6 | 2011-07-12 12:30:59 +0200 | [diff] [blame] | 3582 | ieee80211_sta_connection_lost(sdata, bssid, |
Johannes Berg | 6b684db | 2013-01-29 11:35:29 +0100 | [diff] [blame] | 3583 | WLAN_REASON_DISASSOC_DUE_TO_INACTIVITY, false); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3584 | } |
| 3585 | } |
| 3586 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3587 | sdata_unlock(sdata); |
Johannes Berg | 60f8b39 | 2008-09-08 17:44:22 +0200 | [diff] [blame] | 3588 | } |
Johannes Berg | 0a51b27 | 2008-09-08 17:44:25 +0200 | [diff] [blame] | 3589 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3590 | static void ieee80211_sta_bcn_mon_timer(unsigned long data) |
| 3591 | { |
| 3592 | struct ieee80211_sub_if_data *sdata = |
| 3593 | (struct ieee80211_sub_if_data *) data; |
| 3594 | struct ieee80211_local *local = sdata->local; |
| 3595 | |
| 3596 | if (local->quiescing) |
| 3597 | return; |
| 3598 | |
Michal Kazior | e5593f5 | 2014-04-09 15:45:36 +0200 | [diff] [blame] | 3599 | if (sdata->vif.csa_active) |
| 3600 | return; |
| 3601 | |
Johannes Berg | 682bd38 | 2013-01-29 13:13:50 +0100 | [diff] [blame] | 3602 | sdata->u.mgd.connection_loss = false; |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 3603 | ieee80211_queue_work(&sdata->local->hw, |
| 3604 | &sdata->u.mgd.beacon_connection_loss_work); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3605 | } |
| 3606 | |
| 3607 | static void ieee80211_sta_conn_mon_timer(unsigned long data) |
| 3608 | { |
| 3609 | struct ieee80211_sub_if_data *sdata = |
| 3610 | (struct ieee80211_sub_if_data *) data; |
| 3611 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3612 | struct ieee80211_local *local = sdata->local; |
| 3613 | |
| 3614 | if (local->quiescing) |
| 3615 | return; |
| 3616 | |
Michal Kazior | e5593f5 | 2014-04-09 15:45:36 +0200 | [diff] [blame] | 3617 | if (sdata->vif.csa_active) |
| 3618 | return; |
| 3619 | |
Luis R. Rodriguez | 42935ec | 2009-07-29 20:08:07 -0400 | [diff] [blame] | 3620 | ieee80211_queue_work(&local->hw, &ifmgd->monitor_work); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3621 | } |
| 3622 | |
| 3623 | static void ieee80211_sta_monitor_work(struct work_struct *work) |
| 3624 | { |
| 3625 | struct ieee80211_sub_if_data *sdata = |
| 3626 | container_of(work, struct ieee80211_sub_if_data, |
| 3627 | u.mgd.monitor_work); |
| 3628 | |
| 3629 | ieee80211_mgd_probe_ap(sdata, false); |
| 3630 | } |
| 3631 | |
Johannes Berg | a1678f8 | 2008-09-11 00:01:47 +0200 | [diff] [blame] | 3632 | static void ieee80211_restart_sta_timer(struct ieee80211_sub_if_data *sdata) |
| 3633 | { |
Eliad Peller | 494f1fe | 2012-02-19 15:26:09 +0200 | [diff] [blame] | 3634 | u32 flags; |
| 3635 | |
Kalle Valo | ad93568 | 2009-04-19 08:47:19 +0300 | [diff] [blame] | 3636 | if (sdata->vif.type == NL80211_IFTYPE_STATION) { |
Stanislaw Gruszka | 925e64c | 2012-05-16 15:27:20 +0200 | [diff] [blame] | 3637 | __ieee80211_stop_poll(sdata); |
Kalle Valo | ad93568 | 2009-04-19 08:47:19 +0300 | [diff] [blame] | 3638 | |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3639 | /* let's probe the connection once */ |
Eliad Peller | 494f1fe | 2012-02-19 15:26:09 +0200 | [diff] [blame] | 3640 | flags = sdata->local->hw.flags; |
| 3641 | if (!(flags & IEEE80211_HW_CONNECTION_MONITOR)) |
| 3642 | ieee80211_queue_work(&sdata->local->hw, |
| 3643 | &sdata->u.mgd.monitor_work); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3644 | /* and do all the other regular work too */ |
Johannes Berg | 64592c8 | 2010-06-10 10:21:31 +0200 | [diff] [blame] | 3645 | ieee80211_queue_work(&sdata->local->hw, &sdata->work); |
Kalle Valo | ad93568 | 2009-04-19 08:47:19 +0300 | [diff] [blame] | 3646 | } |
Johannes Berg | a1678f8 | 2008-09-11 00:01:47 +0200 | [diff] [blame] | 3647 | } |
| 3648 | |
Johannes Berg | b8360ab | 2013-04-29 14:57:44 +0200 | [diff] [blame] | 3649 | #ifdef CONFIG_PM |
Johannes Berg | 1a1cb74 | 2014-03-19 09:55:55 +0100 | [diff] [blame] | 3650 | void ieee80211_mgd_quiesce(struct ieee80211_sub_if_data *sdata) |
| 3651 | { |
| 3652 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3653 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
| 3654 | |
| 3655 | sdata_lock(sdata); |
| 3656 | |
Emmanuel Grumbach | c52666a | 2014-05-13 12:54:09 +0300 | [diff] [blame] | 3657 | if (ifmgd->auth_data || ifmgd->assoc_data) { |
| 3658 | const u8 *bssid = ifmgd->auth_data ? |
| 3659 | ifmgd->auth_data->bss->bssid : |
| 3660 | ifmgd->assoc_data->bss->bssid; |
| 3661 | |
Johannes Berg | 1a1cb74 | 2014-03-19 09:55:55 +0100 | [diff] [blame] | 3662 | /* |
Emmanuel Grumbach | c52666a | 2014-05-13 12:54:09 +0300 | [diff] [blame] | 3663 | * If we are trying to authenticate / associate while suspending, |
| 3664 | * cfg80211 won't know and won't actually abort those attempts, |
| 3665 | * thus we need to do that ourselves. |
Johannes Berg | 1a1cb74 | 2014-03-19 09:55:55 +0100 | [diff] [blame] | 3666 | */ |
Emmanuel Grumbach | c52666a | 2014-05-13 12:54:09 +0300 | [diff] [blame] | 3667 | ieee80211_send_deauth_disassoc(sdata, bssid, |
Johannes Berg | 1a1cb74 | 2014-03-19 09:55:55 +0100 | [diff] [blame] | 3668 | IEEE80211_STYPE_DEAUTH, |
| 3669 | WLAN_REASON_DEAUTH_LEAVING, |
| 3670 | false, frame_buf); |
Emmanuel Grumbach | c52666a | 2014-05-13 12:54:09 +0300 | [diff] [blame] | 3671 | if (ifmgd->assoc_data) |
| 3672 | ieee80211_destroy_assoc_data(sdata, false); |
| 3673 | if (ifmgd->auth_data) |
| 3674 | ieee80211_destroy_auth_data(sdata, false); |
Johannes Berg | 1a1cb74 | 2014-03-19 09:55:55 +0100 | [diff] [blame] | 3675 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 3676 | IEEE80211_DEAUTH_FRAME_LEN); |
| 3677 | } |
| 3678 | |
| 3679 | sdata_unlock(sdata); |
| 3680 | } |
| 3681 | |
Johannes Berg | b8360ab | 2013-04-29 14:57:44 +0200 | [diff] [blame] | 3682 | void ieee80211_sta_restart(struct ieee80211_sub_if_data *sdata) |
| 3683 | { |
| 3684 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3685 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3686 | sdata_lock(sdata); |
Johannes Berg | b8360ab | 2013-04-29 14:57:44 +0200 | [diff] [blame] | 3687 | if (!ifmgd->associated) { |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3688 | sdata_unlock(sdata); |
Johannes Berg | b8360ab | 2013-04-29 14:57:44 +0200 | [diff] [blame] | 3689 | return; |
| 3690 | } |
| 3691 | |
| 3692 | if (sdata->flags & IEEE80211_SDATA_DISCONNECT_RESUME) { |
| 3693 | sdata->flags &= ~IEEE80211_SDATA_DISCONNECT_RESUME; |
| 3694 | mlme_dbg(sdata, "driver requested disconnect after resume\n"); |
| 3695 | ieee80211_sta_connection_lost(sdata, |
| 3696 | ifmgd->associated->bssid, |
| 3697 | WLAN_REASON_UNSPECIFIED, |
| 3698 | true); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3699 | sdata_unlock(sdata); |
Johannes Berg | b8360ab | 2013-04-29 14:57:44 +0200 | [diff] [blame] | 3700 | return; |
| 3701 | } |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 3702 | sdata_unlock(sdata); |
Johannes Berg | b8360ab | 2013-04-29 14:57:44 +0200 | [diff] [blame] | 3703 | } |
| 3704 | #endif |
| 3705 | |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 3706 | /* interface setup */ |
| 3707 | void ieee80211_sta_setup_sdata(struct ieee80211_sub_if_data *sdata) |
| 3708 | { |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 3709 | struct ieee80211_if_managed *ifmgd; |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 3710 | |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 3711 | ifmgd = &sdata->u.mgd; |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3712 | INIT_WORK(&ifmgd->monitor_work, ieee80211_sta_monitor_work); |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 3713 | INIT_WORK(&ifmgd->chswitch_work, ieee80211_chswitch_work); |
Juuso Oikarinen | 1e4dcd0 | 2010-03-19 07:14:53 +0200 | [diff] [blame] | 3714 | INIT_WORK(&ifmgd->beacon_connection_loss_work, |
| 3715 | ieee80211_beacon_connection_loss_work); |
Johannes Berg | 882a7c6 | 2012-08-01 22:32:45 +0200 | [diff] [blame] | 3716 | INIT_WORK(&ifmgd->csa_connection_drop_work, |
| 3717 | ieee80211_csa_connection_drop_work); |
Emmanuel Grumbach | 687da13 | 2013-10-01 16:45:43 +0300 | [diff] [blame] | 3718 | INIT_WORK(&ifmgd->request_smps_work, ieee80211_request_smps_mgd_work); |
Arik Nemtsov | 81dd2b8 | 2014-07-17 17:14:25 +0300 | [diff] [blame] | 3719 | INIT_DELAYED_WORK(&ifmgd->tdls_peer_del_work, |
| 3720 | ieee80211_tdls_peer_del_work); |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 3721 | setup_timer(&ifmgd->timer, ieee80211_sta_timer, |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 3722 | (unsigned long) sdata); |
Johannes Berg | b291ba1 | 2009-07-10 15:29:03 +0200 | [diff] [blame] | 3723 | setup_timer(&ifmgd->bcn_mon_timer, ieee80211_sta_bcn_mon_timer, |
| 3724 | (unsigned long) sdata); |
| 3725 | setup_timer(&ifmgd->conn_mon_timer, ieee80211_sta_conn_mon_timer, |
| 3726 | (unsigned long) sdata); |
Johannes Berg | 4690029 | 2009-02-15 12:44:28 +0100 | [diff] [blame] | 3727 | setup_timer(&ifmgd->chswitch_timer, ieee80211_chswitch_timer, |
Sujith | c481ec9 | 2009-01-06 09:28:37 +0530 | [diff] [blame] | 3728 | (unsigned long) sdata); |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 3729 | |
Johannes Berg | ab1faea | 2009-07-01 21:41:17 +0200 | [diff] [blame] | 3730 | ifmgd->flags = 0; |
Mohammed Shafi Shajakhan | 1478acb | 2011-12-14 19:46:08 +0530 | [diff] [blame] | 3731 | ifmgd->powersave = sdata->wdev.ps; |
Alexander Bondar | 219c386 | 2013-01-22 16:52:23 +0200 | [diff] [blame] | 3732 | ifmgd->uapsd_queues = sdata->local->hw.uapsd_queues; |
| 3733 | ifmgd->uapsd_max_sp_len = sdata->local->hw.uapsd_max_sp_len; |
Janusz Dziedzic | 67baf66 | 2013-03-21 15:47:56 +0100 | [diff] [blame] | 3734 | ifmgd->p2p_noa_index = -1; |
Johannes Berg | bbbdff9 | 2009-04-16 13:27:42 +0200 | [diff] [blame] | 3735 | |
Johannes Berg | 0f78231 | 2009-12-01 13:37:02 +0100 | [diff] [blame] | 3736 | if (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS) |
| 3737 | ifmgd->req_smps = IEEE80211_SMPS_AUTOMATIC; |
| 3738 | else |
| 3739 | ifmgd->req_smps = IEEE80211_SMPS_OFF; |
Johannes Berg | 9c6bd79 | 2008-09-11 00:01:52 +0200 | [diff] [blame] | 3740 | } |
| 3741 | |
| 3742 | /* scan finished notification */ |
Johannes Berg | 0a51b27 | 2008-09-08 17:44:25 +0200 | [diff] [blame] | 3743 | void ieee80211_mlme_notify_scan_completed(struct ieee80211_local *local) |
| 3744 | { |
Johannes Berg | 31ee67a | 2012-07-06 21:18:24 +0200 | [diff] [blame] | 3745 | struct ieee80211_sub_if_data *sdata; |
Johannes Berg | a1678f8 | 2008-09-11 00:01:47 +0200 | [diff] [blame] | 3746 | |
| 3747 | /* Restart STA timers */ |
| 3748 | rcu_read_lock(); |
Ben Greear | 370bd00 | 2013-03-19 17:50:50 -0700 | [diff] [blame] | 3749 | list_for_each_entry_rcu(sdata, &local->interfaces, list) { |
| 3750 | if (ieee80211_sdata_running(sdata)) |
| 3751 | ieee80211_restart_sta_timer(sdata); |
| 3752 | } |
Johannes Berg | a1678f8 | 2008-09-11 00:01:47 +0200 | [diff] [blame] | 3753 | rcu_read_unlock(); |
Johannes Berg | 0a51b27 | 2008-09-08 17:44:25 +0200 | [diff] [blame] | 3754 | } |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 3755 | |
| 3756 | int ieee80211_max_network_latency(struct notifier_block *nb, |
| 3757 | unsigned long data, void *dummy) |
| 3758 | { |
| 3759 | s32 latency_usec = (s32) data; |
| 3760 | struct ieee80211_local *local = |
| 3761 | container_of(nb, struct ieee80211_local, |
| 3762 | network_latency_notifier); |
| 3763 | |
| 3764 | mutex_lock(&local->iflist_mtx); |
| 3765 | ieee80211_recalc_ps(local, latency_usec); |
| 3766 | mutex_unlock(&local->iflist_mtx); |
| 3767 | |
Zhao, Gang | 8bd811a | 2014-04-21 12:53:05 +0800 | [diff] [blame] | 3768 | return NOTIFY_OK; |
Johannes Berg | 10f644a | 2009-04-16 13:17:25 +0200 | [diff] [blame] | 3769 | } |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 3770 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3771 | static u8 ieee80211_ht_vht_rx_chains(struct ieee80211_sub_if_data *sdata, |
| 3772 | struct cfg80211_bss *cbss) |
| 3773 | { |
| 3774 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3775 | const u8 *ht_cap_ie, *vht_cap_ie; |
| 3776 | const struct ieee80211_ht_cap *ht_cap; |
| 3777 | const struct ieee80211_vht_cap *vht_cap; |
| 3778 | u8 chains = 1; |
| 3779 | |
| 3780 | if (ifmgd->flags & IEEE80211_STA_DISABLE_HT) |
| 3781 | return chains; |
| 3782 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3783 | ht_cap_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_HT_CAPABILITY); |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3784 | if (ht_cap_ie && ht_cap_ie[1] >= sizeof(*ht_cap)) { |
| 3785 | ht_cap = (void *)(ht_cap_ie + 2); |
| 3786 | chains = ieee80211_mcs_to_chains(&ht_cap->mcs); |
| 3787 | /* |
| 3788 | * TODO: use "Tx Maximum Number Spatial Streams Supported" and |
| 3789 | * "Tx Unequal Modulation Supported" fields. |
| 3790 | */ |
| 3791 | } |
| 3792 | |
| 3793 | if (ifmgd->flags & IEEE80211_STA_DISABLE_VHT) |
| 3794 | return chains; |
| 3795 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3796 | vht_cap_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_VHT_CAPABILITY); |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3797 | if (vht_cap_ie && vht_cap_ie[1] >= sizeof(*vht_cap)) { |
| 3798 | u8 nss; |
| 3799 | u16 tx_mcs_map; |
| 3800 | |
| 3801 | vht_cap = (void *)(vht_cap_ie + 2); |
| 3802 | tx_mcs_map = le16_to_cpu(vht_cap->supp_mcs.tx_mcs_map); |
| 3803 | for (nss = 8; nss > 0; nss--) { |
| 3804 | if (((tx_mcs_map >> (2 * (nss - 1))) & 3) != |
| 3805 | IEEE80211_VHT_MCS_NOT_SUPPORTED) |
| 3806 | break; |
| 3807 | } |
| 3808 | /* TODO: use "Tx Highest Supported Long GI Data Rate" field? */ |
| 3809 | chains = max(chains, nss); |
| 3810 | } |
| 3811 | |
| 3812 | return chains; |
| 3813 | } |
| 3814 | |
Johannes Berg | b17166a | 2012-07-27 11:41:27 +0200 | [diff] [blame] | 3815 | static int ieee80211_prep_channel(struct ieee80211_sub_if_data *sdata, |
| 3816 | struct cfg80211_bss *cbss) |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 3817 | { |
| 3818 | struct ieee80211_local *local = sdata->local; |
| 3819 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 3820 | const struct ieee80211_ht_cap *ht_cap = NULL; |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3821 | const struct ieee80211_ht_operation *ht_oper = NULL; |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3822 | const struct ieee80211_vht_operation *vht_oper = NULL; |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3823 | struct ieee80211_supported_band *sband; |
Johannes Berg | 4bf8853 | 2012-11-09 11:39:59 +0100 | [diff] [blame] | 3824 | struct cfg80211_chan_def chandef; |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3825 | int ret; |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 3826 | |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3827 | sband = local->hw.wiphy->bands[cbss->channel->band]; |
| 3828 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3829 | ifmgd->flags &= ~(IEEE80211_STA_DISABLE_40MHZ | |
| 3830 | IEEE80211_STA_DISABLE_80P80MHZ | |
| 3831 | IEEE80211_STA_DISABLE_160MHZ); |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3832 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3833 | rcu_read_lock(); |
| 3834 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3835 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_HT) && |
| 3836 | sband->ht_cap.ht_supported) { |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 3837 | const u8 *ht_oper_ie, *ht_cap_ie; |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3838 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3839 | ht_oper_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_HT_OPERATION); |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3840 | if (ht_oper_ie && ht_oper_ie[1] >= sizeof(*ht_oper)) |
| 3841 | ht_oper = (void *)(ht_oper_ie + 2); |
Johannes Berg | 08e6eff | 2013-02-07 23:33:32 +0100 | [diff] [blame] | 3842 | |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 3843 | ht_cap_ie = ieee80211_bss_get_ie(cbss, WLAN_EID_HT_CAPABILITY); |
| 3844 | if (ht_cap_ie && ht_cap_ie[1] >= sizeof(*ht_cap)) |
| 3845 | ht_cap = (void *)(ht_cap_ie + 2); |
| 3846 | |
| 3847 | if (!ht_cap) { |
Johannes Berg | 08e6eff | 2013-02-07 23:33:32 +0100 | [diff] [blame] | 3848 | ifmgd->flags |= IEEE80211_STA_DISABLE_HT; |
| 3849 | ht_oper = NULL; |
| 3850 | } |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3851 | } |
| 3852 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3853 | if (!(ifmgd->flags & IEEE80211_STA_DISABLE_VHT) && |
| 3854 | sband->vht_cap.vht_supported) { |
Johannes Berg | 08e6eff | 2013-02-07 23:33:32 +0100 | [diff] [blame] | 3855 | const u8 *vht_oper_ie, *vht_cap; |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3856 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3857 | vht_oper_ie = ieee80211_bss_get_ie(cbss, |
| 3858 | WLAN_EID_VHT_OPERATION); |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3859 | if (vht_oper_ie && vht_oper_ie[1] >= sizeof(*vht_oper)) |
| 3860 | vht_oper = (void *)(vht_oper_ie + 2); |
| 3861 | if (vht_oper && !ht_oper) { |
| 3862 | vht_oper = NULL; |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3863 | sdata_info(sdata, |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3864 | "AP advertised VHT without HT, disabling both\n"); |
Johannes Berg | cb14502 | 2013-02-07 20:41:50 +0100 | [diff] [blame] | 3865 | ifmgd->flags |= IEEE80211_STA_DISABLE_HT; |
| 3866 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3867 | } |
Johannes Berg | 08e6eff | 2013-02-07 23:33:32 +0100 | [diff] [blame] | 3868 | |
| 3869 | vht_cap = ieee80211_bss_get_ie(cbss, WLAN_EID_VHT_CAPABILITY); |
| 3870 | if (!vht_cap || vht_cap[1] < sizeof(struct ieee80211_vht_cap)) { |
| 3871 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
| 3872 | vht_oper = NULL; |
| 3873 | } |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3874 | } |
| 3875 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3876 | ifmgd->flags |= ieee80211_determine_chantype(sdata, sband, |
| 3877 | cbss->channel, |
Eliad Peller | 53b954e | 2014-07-24 11:20:05 +0300 | [diff] [blame] | 3878 | ht_cap, ht_oper, vht_oper, |
Johannes Berg | 5cdaed1 | 2013-07-31 11:23:06 +0200 | [diff] [blame] | 3879 | &chandef, false); |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 3880 | |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3881 | sdata->needed_rx_chains = min(ieee80211_ht_vht_rx_chains(sdata, cbss), |
| 3882 | local->rx_chains); |
Johannes Berg | 24398e3 | 2012-03-28 10:58:36 +0200 | [diff] [blame] | 3883 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 3884 | rcu_read_unlock(); |
| 3885 | |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 3886 | /* will change later if needed */ |
| 3887 | sdata->smps_mode = IEEE80211_SMPS_OFF; |
| 3888 | |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 3889 | mutex_lock(&local->mtx); |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3890 | /* |
| 3891 | * If this fails (possibly due to channel context sharing |
| 3892 | * on incompatible channels, e.g. 80+80 and 160 sharing the |
| 3893 | * same control channel) try to use a smaller bandwidth. |
| 3894 | */ |
| 3895 | ret = ieee80211_vif_use_channel(sdata, &chandef, |
| 3896 | IEEE80211_CHANCTX_SHARED); |
Simon Wunderlich | 0418a44 | 2013-05-16 13:00:31 +0200 | [diff] [blame] | 3897 | |
| 3898 | /* don't downgrade for 5 and 10 MHz channels, though. */ |
| 3899 | if (chandef.width == NL80211_CHAN_WIDTH_5 || |
| 3900 | chandef.width == NL80211_CHAN_WIDTH_10) |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 3901 | goto out; |
Simon Wunderlich | 0418a44 | 2013-05-16 13:00:31 +0200 | [diff] [blame] | 3902 | |
Johannes Berg | d601cd8 | 2013-02-07 20:54:51 +0100 | [diff] [blame] | 3903 | while (ret && chandef.width != NL80211_CHAN_WIDTH_20_NOHT) { |
Simon Wunderlich | e6b7cde | 2013-08-28 13:41:29 +0200 | [diff] [blame] | 3904 | ifmgd->flags |= ieee80211_chandef_downgrade(&chandef); |
Johannes Berg | d601cd8 | 2013-02-07 20:54:51 +0100 | [diff] [blame] | 3905 | ret = ieee80211_vif_use_channel(sdata, &chandef, |
| 3906 | IEEE80211_CHANCTX_SHARED); |
| 3907 | } |
Johannes Berg | 34a3740 | 2013-12-18 09:43:33 +0100 | [diff] [blame] | 3908 | out: |
| 3909 | mutex_unlock(&local->mtx); |
Johannes Berg | f2d9d27 | 2012-11-22 14:11:39 +0100 | [diff] [blame] | 3910 | return ret; |
Johannes Berg | b17166a | 2012-07-27 11:41:27 +0200 | [diff] [blame] | 3911 | } |
| 3912 | |
| 3913 | static int ieee80211_prep_connection(struct ieee80211_sub_if_data *sdata, |
| 3914 | struct cfg80211_bss *cbss, bool assoc) |
| 3915 | { |
| 3916 | struct ieee80211_local *local = sdata->local; |
| 3917 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 3918 | struct ieee80211_bss *bss = (void *)cbss->priv; |
| 3919 | struct sta_info *new_sta = NULL; |
| 3920 | bool have_sta = false; |
| 3921 | int err; |
| 3922 | |
| 3923 | if (WARN_ON(!ifmgd->auth_data && !ifmgd->assoc_data)) |
| 3924 | return -EINVAL; |
| 3925 | |
| 3926 | if (assoc) { |
| 3927 | rcu_read_lock(); |
| 3928 | have_sta = sta_info_get(sdata, cbss->bssid); |
| 3929 | rcu_read_unlock(); |
| 3930 | } |
| 3931 | |
| 3932 | if (!have_sta) { |
| 3933 | new_sta = sta_info_alloc(sdata, cbss->bssid, GFP_KERNEL); |
| 3934 | if (!new_sta) |
| 3935 | return -ENOMEM; |
| 3936 | } |
Johannes Berg | 13e0c8e | 2012-07-27 10:43:16 +0200 | [diff] [blame] | 3937 | if (new_sta) { |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3938 | u32 rates = 0, basic_rates = 0; |
| 3939 | bool have_higher_than_11mbit; |
| 3940 | int min_rate = INT_MAX, min_rate_index = -1; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 3941 | struct ieee80211_chanctx_conf *chanctx_conf; |
Johannes Berg | b17166a | 2012-07-27 11:41:27 +0200 | [diff] [blame] | 3942 | struct ieee80211_supported_band *sband; |
Johannes Berg | 8cef2c9 | 2013-02-05 16:54:31 +0100 | [diff] [blame] | 3943 | const struct cfg80211_bss_ies *ies; |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 3944 | int shift; |
| 3945 | u32 rate_flags; |
Johannes Berg | b17166a | 2012-07-27 11:41:27 +0200 | [diff] [blame] | 3946 | |
| 3947 | sband = local->hw.wiphy->bands[cbss->channel->band]; |
| 3948 | |
| 3949 | err = ieee80211_prep_channel(sdata, cbss); |
| 3950 | if (err) { |
| 3951 | sta_info_free(local, new_sta); |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 3952 | return -EINVAL; |
Johannes Berg | b17166a | 2012-07-27 11:41:27 +0200 | [diff] [blame] | 3953 | } |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 3954 | shift = ieee80211_vif_get_shift(&sdata->vif); |
| 3955 | |
| 3956 | rcu_read_lock(); |
| 3957 | chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf); |
| 3958 | if (WARN_ON(!chanctx_conf)) { |
| 3959 | rcu_read_unlock(); |
Eytan Lifshitz | c368dda | 2014-02-06 21:01:32 +0200 | [diff] [blame] | 3960 | sta_info_free(local, new_sta); |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 3961 | return -EINVAL; |
| 3962 | } |
| 3963 | rate_flags = ieee80211_chandef_rate_flags(&chanctx_conf->def); |
| 3964 | rcu_read_unlock(); |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3965 | |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3966 | ieee80211_get_rates(sband, bss->supp_rates, |
| 3967 | bss->supp_rates_len, |
| 3968 | &rates, &basic_rates, |
| 3969 | &have_higher_than_11mbit, |
Simon Wunderlich | 2103dec | 2013-07-08 16:55:53 +0200 | [diff] [blame] | 3970 | &min_rate, &min_rate_index, |
| 3971 | shift, rate_flags); |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3972 | |
| 3973 | /* |
| 3974 | * This used to be a workaround for basic rates missing |
| 3975 | * in the association response frame. Now that we no |
| 3976 | * longer use the basic rates from there, it probably |
| 3977 | * doesn't happen any more, but keep the workaround so |
| 3978 | * in case some *other* APs are buggy in different ways |
| 3979 | * we can connect -- with a warning. |
| 3980 | */ |
| 3981 | if (!basic_rates && min_rate_index >= 0) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 3982 | sdata_info(sdata, |
| 3983 | "No basic rates, using min rate instead\n"); |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3984 | basic_rates = BIT(min_rate_index); |
| 3985 | } |
| 3986 | |
Johannes Berg | 13e0c8e | 2012-07-27 10:43:16 +0200 | [diff] [blame] | 3987 | new_sta->sta.supp_rates[cbss->channel->band] = rates; |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3988 | sdata->vif.bss_conf.basic_rates = basic_rates; |
| 3989 | |
| 3990 | /* cf. IEEE 802.11 9.2.12 */ |
Johannes Berg | 55de908 | 2012-07-26 17:24:39 +0200 | [diff] [blame] | 3991 | if (cbss->channel->band == IEEE80211_BAND_2GHZ && |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 3992 | have_higher_than_11mbit) |
| 3993 | sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE; |
| 3994 | else |
| 3995 | sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE; |
| 3996 | |
| 3997 | memcpy(ifmgd->bssid, cbss->bssid, ETH_ALEN); |
| 3998 | |
Johannes Berg | 8c358bc | 2012-05-22 22:13:05 +0200 | [diff] [blame] | 3999 | /* set timing information */ |
| 4000 | sdata->vif.bss_conf.beacon_int = cbss->beacon_interval; |
Johannes Berg | 8cef2c9 | 2013-02-05 16:54:31 +0100 | [diff] [blame] | 4001 | rcu_read_lock(); |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 4002 | ies = rcu_dereference(cbss->beacon_ies); |
| 4003 | if (ies) { |
| 4004 | const u8 *tim_ie; |
| 4005 | |
| 4006 | sdata->vif.bss_conf.sync_tsf = ies->tsf; |
| 4007 | sdata->vif.bss_conf.sync_device_ts = |
| 4008 | bss->device_ts_beacon; |
| 4009 | tim_ie = cfg80211_find_ie(WLAN_EID_TIM, |
| 4010 | ies->data, ies->len); |
| 4011 | if (tim_ie && tim_ie[1] >= 2) |
| 4012 | sdata->vif.bss_conf.sync_dtim_count = tim_ie[2]; |
| 4013 | else |
| 4014 | sdata->vif.bss_conf.sync_dtim_count = 0; |
| 4015 | } else if (!(local->hw.flags & |
| 4016 | IEEE80211_HW_TIMING_BEACON_ONLY)) { |
| 4017 | ies = rcu_dereference(cbss->proberesp_ies); |
| 4018 | /* must be non-NULL since beacon IEs were NULL */ |
| 4019 | sdata->vif.bss_conf.sync_tsf = ies->tsf; |
| 4020 | sdata->vif.bss_conf.sync_device_ts = |
| 4021 | bss->device_ts_presp; |
| 4022 | sdata->vif.bss_conf.sync_dtim_count = 0; |
| 4023 | } else { |
| 4024 | sdata->vif.bss_conf.sync_tsf = 0; |
| 4025 | sdata->vif.bss_conf.sync_device_ts = 0; |
| 4026 | sdata->vif.bss_conf.sync_dtim_count = 0; |
| 4027 | } |
Johannes Berg | 8cef2c9 | 2013-02-05 16:54:31 +0100 | [diff] [blame] | 4028 | rcu_read_unlock(); |
Johannes Berg | 8c358bc | 2012-05-22 22:13:05 +0200 | [diff] [blame] | 4029 | |
| 4030 | /* tell driver about BSSID, basic rates and timing */ |
Johannes Berg | 5d6a1b0 | 2012-03-08 15:02:08 +0100 | [diff] [blame] | 4031 | ieee80211_bss_info_change_notify(sdata, |
Johannes Berg | 8c358bc | 2012-05-22 22:13:05 +0200 | [diff] [blame] | 4032 | BSS_CHANGED_BSSID | BSS_CHANGED_BASIC_RATES | |
| 4033 | BSS_CHANGED_BEACON_INT); |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4034 | |
| 4035 | if (assoc) |
Johannes Berg | 13e0c8e | 2012-07-27 10:43:16 +0200 | [diff] [blame] | 4036 | sta_info_pre_move_state(new_sta, IEEE80211_STA_AUTH); |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4037 | |
Johannes Berg | 13e0c8e | 2012-07-27 10:43:16 +0200 | [diff] [blame] | 4038 | err = sta_info_insert(new_sta); |
| 4039 | new_sta = NULL; |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4040 | if (err) { |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 4041 | sdata_info(sdata, |
| 4042 | "failed to insert STA entry for the AP (error %d)\n", |
| 4043 | err); |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4044 | return err; |
| 4045 | } |
| 4046 | } else |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 4047 | WARN_ON_ONCE(!ether_addr_equal(ifmgd->bssid, cbss->bssid)); |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4048 | |
| 4049 | return 0; |
| 4050 | } |
| 4051 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4052 | /* config hooks */ |
| 4053 | int ieee80211_mgd_auth(struct ieee80211_sub_if_data *sdata, |
| 4054 | struct cfg80211_auth_request *req) |
| 4055 | { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4056 | struct ieee80211_local *local = sdata->local; |
| 4057 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 4058 | struct ieee80211_mgd_auth_data *auth_data; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4059 | u16 auth_alg; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4060 | int err; |
| 4061 | |
| 4062 | /* prepare auth data structure */ |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4063 | |
| 4064 | switch (req->auth_type) { |
| 4065 | case NL80211_AUTHTYPE_OPEN_SYSTEM: |
| 4066 | auth_alg = WLAN_AUTH_OPEN; |
| 4067 | break; |
| 4068 | case NL80211_AUTHTYPE_SHARED_KEY: |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4069 | if (IS_ERR(local->wep_tx_tfm)) |
Johannes Berg | 9dca9c4 | 2010-07-21 10:09:25 +0200 | [diff] [blame] | 4070 | return -EOPNOTSUPP; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4071 | auth_alg = WLAN_AUTH_SHARED_KEY; |
| 4072 | break; |
| 4073 | case NL80211_AUTHTYPE_FT: |
| 4074 | auth_alg = WLAN_AUTH_FT; |
| 4075 | break; |
| 4076 | case NL80211_AUTHTYPE_NETWORK_EAP: |
| 4077 | auth_alg = WLAN_AUTH_LEAP; |
| 4078 | break; |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 4079 | case NL80211_AUTHTYPE_SAE: |
| 4080 | auth_alg = WLAN_AUTH_SAE; |
| 4081 | break; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4082 | default: |
| 4083 | return -EOPNOTSUPP; |
| 4084 | } |
| 4085 | |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 4086 | auth_data = kzalloc(sizeof(*auth_data) + req->sae_data_len + |
| 4087 | req->ie_len, GFP_KERNEL); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4088 | if (!auth_data) |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4089 | return -ENOMEM; |
| 4090 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4091 | auth_data->bss = req->bss; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4092 | |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 4093 | if (req->sae_data_len >= 4) { |
| 4094 | __le16 *pos = (__le16 *) req->sae_data; |
| 4095 | auth_data->sae_trans = le16_to_cpu(pos[0]); |
| 4096 | auth_data->sae_status = le16_to_cpu(pos[1]); |
| 4097 | memcpy(auth_data->data, req->sae_data + 4, |
| 4098 | req->sae_data_len - 4); |
| 4099 | auth_data->data_len += req->sae_data_len - 4; |
| 4100 | } |
| 4101 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4102 | if (req->ie && req->ie_len) { |
Jouni Malinen | 6b8ece3 | 2012-09-30 19:29:40 +0300 | [diff] [blame] | 4103 | memcpy(&auth_data->data[auth_data->data_len], |
| 4104 | req->ie, req->ie_len); |
| 4105 | auth_data->data_len += req->ie_len; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4106 | } |
| 4107 | |
Johannes Berg | fffd093 | 2009-07-08 14:22:54 +0200 | [diff] [blame] | 4108 | if (req->key && req->key_len) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4109 | auth_data->key_len = req->key_len; |
| 4110 | auth_data->key_idx = req->key_idx; |
| 4111 | memcpy(auth_data->key, req->key, req->key_len); |
Johannes Berg | fffd093 | 2009-07-08 14:22:54 +0200 | [diff] [blame] | 4112 | } |
| 4113 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4114 | auth_data->algorithm = auth_alg; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4115 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4116 | /* try to authenticate/probe */ |
Johannes Berg | f679f65 | 2009-12-23 13:15:34 +0100 | [diff] [blame] | 4117 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4118 | if ((ifmgd->auth_data && !ifmgd->auth_data->done) || |
| 4119 | ifmgd->assoc_data) { |
| 4120 | err = -EBUSY; |
| 4121 | goto err_free; |
| 4122 | } |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4123 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4124 | if (ifmgd->auth_data) |
| 4125 | ieee80211_destroy_auth_data(sdata, false); |
Guy Eilam | 2a33bee | 2011-08-17 15:18:15 +0300 | [diff] [blame] | 4126 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4127 | /* prep auth_data so we don't go into idle on disassoc */ |
| 4128 | ifmgd->auth_data = auth_data; |
| 4129 | |
Johannes Berg | 7b119dc | 2013-04-10 21:38:36 +0200 | [diff] [blame] | 4130 | if (ifmgd->associated) { |
| 4131 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
| 4132 | |
| 4133 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, |
| 4134 | WLAN_REASON_UNSPECIFIED, |
| 4135 | false, frame_buf); |
| 4136 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 4137 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 4138 | sizeof(frame_buf)); |
Johannes Berg | 7b119dc | 2013-04-10 21:38:36 +0200 | [diff] [blame] | 4139 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4140 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 4141 | sdata_info(sdata, "authenticate with %pM\n", req->bss->bssid); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4142 | |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4143 | err = ieee80211_prep_connection(sdata, req->bss, false); |
| 4144 | if (err) |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4145 | goto err_clear; |
Guy Eilam | 2a33bee | 2011-08-17 15:18:15 +0300 | [diff] [blame] | 4146 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4147 | err = ieee80211_probe_auth(sdata); |
| 4148 | if (err) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4149 | sta_info_destroy_addr(sdata, req->bss->bssid); |
| 4150 | goto err_clear; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4151 | } |
| 4152 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4153 | /* hold our own reference */ |
Johannes Berg | 5b112d3 | 2013-02-01 01:49:58 +0100 | [diff] [blame] | 4154 | cfg80211_ref_bss(local->hw.wiphy, auth_data->bss); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 4155 | return 0; |
Johannes Berg | e5b900d | 2010-07-29 16:08:55 +0200 | [diff] [blame] | 4156 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4157 | err_clear: |
Eliad Peller | 3d2abdf | 2012-09-04 17:44:45 +0300 | [diff] [blame] | 4158 | memset(ifmgd->bssid, 0, ETH_ALEN); |
| 4159 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4160 | ifmgd->auth_data = NULL; |
| 4161 | err_free: |
| 4162 | kfree(auth_data); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4163 | return err; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4164 | } |
| 4165 | |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4166 | static bool ieee80211_usable_wmm_params(struct ieee80211_sub_if_data *sdata, |
| 4167 | const u8 *wmm_param, int len) |
| 4168 | { |
| 4169 | const u8 *pos; |
| 4170 | size_t left; |
| 4171 | |
| 4172 | if (len < 8) |
| 4173 | return false; |
| 4174 | |
| 4175 | if (wmm_param[5] != 1 /* version */) |
| 4176 | return false; |
| 4177 | |
| 4178 | pos = wmm_param + 8; |
| 4179 | left = len - 8; |
| 4180 | |
| 4181 | for (; left >= 4; left -= 4, pos += 4) { |
| 4182 | u8 aifsn = pos[0] & 0x0f; |
| 4183 | u8 ecwmin = pos[1] & 0x0f; |
| 4184 | u8 ecwmax = (pos[1] & 0xf0) >> 4; |
| 4185 | int aci = (pos[0] >> 5) & 0x03; |
| 4186 | |
| 4187 | if (aifsn < 2) { |
| 4188 | sdata_info(sdata, |
| 4189 | "AP has invalid WMM params (AIFSN=%d for ACI %d), disabling WMM\n", |
| 4190 | aifsn, aci); |
| 4191 | return false; |
| 4192 | } |
| 4193 | if (ecwmin > ecwmax) { |
| 4194 | sdata_info(sdata, |
| 4195 | "AP has invalid WMM params (ECWmin/max=%d/%d for ACI %d), disabling WMM\n", |
| 4196 | ecwmin, ecwmax, aci); |
| 4197 | return false; |
| 4198 | } |
| 4199 | } |
| 4200 | |
| 4201 | return true; |
| 4202 | } |
| 4203 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4204 | int ieee80211_mgd_assoc(struct ieee80211_sub_if_data *sdata, |
| 4205 | struct cfg80211_assoc_request *req) |
| 4206 | { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4207 | struct ieee80211_local *local = sdata->local; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4208 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Johannes Berg | 0c1ad2c | 2009-12-23 13:15:39 +0100 | [diff] [blame] | 4209 | struct ieee80211_bss *bss = (void *)req->bss->priv; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4210 | struct ieee80211_mgd_assoc_data *assoc_data; |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4211 | const struct cfg80211_bss_ies *beacon_ies; |
Johannes Berg | 4e74bfd | 2012-03-08 15:02:04 +0100 | [diff] [blame] | 4212 | struct ieee80211_supported_band *sband; |
Johannes Berg | b08fbbd | 2012-12-07 13:06:48 +0100 | [diff] [blame] | 4213 | const u8 *ssidie, *ht_ie, *vht_ie; |
Guy Eilam | 2a33bee | 2011-08-17 15:18:15 +0300 | [diff] [blame] | 4214 | int i, err; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4215 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4216 | assoc_data = kzalloc(sizeof(*assoc_data) + req->ie_len, GFP_KERNEL); |
| 4217 | if (!assoc_data) |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4218 | return -ENOMEM; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4219 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 4220 | rcu_read_lock(); |
| 4221 | ssidie = ieee80211_bss_get_ie(req->bss, WLAN_EID_SSID); |
| 4222 | if (!ssidie) { |
| 4223 | rcu_read_unlock(); |
| 4224 | kfree(assoc_data); |
| 4225 | return -EINVAL; |
| 4226 | } |
| 4227 | memcpy(assoc_data->ssid, ssidie + 2, ssidie[1]); |
| 4228 | assoc_data->ssid_len = ssidie[1]; |
| 4229 | rcu_read_unlock(); |
| 4230 | |
Johannes Berg | 7b119dc | 2013-04-10 21:38:36 +0200 | [diff] [blame] | 4231 | if (ifmgd->associated) { |
| 4232 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
| 4233 | |
| 4234 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, |
| 4235 | WLAN_REASON_UNSPECIFIED, |
| 4236 | false, frame_buf); |
| 4237 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 4238 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 4239 | sizeof(frame_buf)); |
Johannes Berg | 7b119dc | 2013-04-10 21:38:36 +0200 | [diff] [blame] | 4240 | } |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4241 | |
| 4242 | if (ifmgd->auth_data && !ifmgd->auth_data->done) { |
| 4243 | err = -EBUSY; |
| 4244 | goto err_free; |
Guy Eilam | 2a33bee | 2011-08-17 15:18:15 +0300 | [diff] [blame] | 4245 | } |
| 4246 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4247 | if (ifmgd->assoc_data) { |
| 4248 | err = -EBUSY; |
| 4249 | goto err_free; |
| 4250 | } |
| 4251 | |
| 4252 | if (ifmgd->auth_data) { |
| 4253 | bool match; |
| 4254 | |
| 4255 | /* keep sta info, bssid if matching */ |
Joe Perches | b203ca3 | 2012-05-08 18:56:52 +0000 | [diff] [blame] | 4256 | match = ether_addr_equal(ifmgd->bssid, req->bss->bssid); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4257 | ieee80211_destroy_auth_data(sdata, match); |
| 4258 | } |
| 4259 | |
| 4260 | /* prepare assoc data */ |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4261 | |
Juuso Oikarinen | d8ec443 | 2010-10-01 16:02:31 +0300 | [diff] [blame] | 4262 | ifmgd->beacon_crc_valid = false; |
| 4263 | |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4264 | assoc_data->wmm = bss->wmm_used && |
| 4265 | (local->hw.queues >= IEEE80211_NUM_ACS); |
| 4266 | if (assoc_data->wmm) { |
| 4267 | /* try to check validity of WMM params IE */ |
| 4268 | const struct cfg80211_bss_ies *ies; |
| 4269 | const u8 *wp, *start, *end; |
| 4270 | |
| 4271 | rcu_read_lock(); |
| 4272 | ies = rcu_dereference(req->bss->ies); |
| 4273 | start = ies->data; |
| 4274 | end = start + ies->len; |
| 4275 | |
| 4276 | while (true) { |
| 4277 | wp = cfg80211_find_vendor_ie( |
| 4278 | WLAN_OUI_MICROSOFT, |
| 4279 | WLAN_OUI_TYPE_MICROSOFT_WMM, |
| 4280 | start, end - start); |
| 4281 | if (!wp) |
| 4282 | break; |
| 4283 | start = wp + wp[1] + 2; |
| 4284 | /* if this IE is too short, try the next */ |
| 4285 | if (wp[1] <= 4) |
| 4286 | continue; |
| 4287 | /* if this IE is WMM params, we found what we wanted */ |
| 4288 | if (wp[6] == 1) |
| 4289 | break; |
| 4290 | } |
| 4291 | |
| 4292 | if (!wp || !ieee80211_usable_wmm_params(sdata, wp + 2, |
| 4293 | wp[1] - 2)) { |
| 4294 | assoc_data->wmm = false; |
| 4295 | ifmgd->flags |= IEEE80211_STA_DISABLE_WMM; |
| 4296 | } |
| 4297 | rcu_read_unlock(); |
| 4298 | } |
| 4299 | |
Johannes Berg | de5036a | 2012-03-08 15:02:03 +0100 | [diff] [blame] | 4300 | /* |
| 4301 | * IEEE802.11n does not allow TKIP/WEP as pairwise ciphers in HT mode. |
| 4302 | * We still associate in non-HT mode (11a/b/g) if any one of these |
| 4303 | * ciphers is configured as pairwise. |
| 4304 | * We can set this to true for non-11n hardware, that'll be checked |
| 4305 | * separately along with the peer capabilities. |
| 4306 | */ |
Johannes Berg | 1c4cb92 | 2012-05-30 15:57:00 +0200 | [diff] [blame] | 4307 | for (i = 0; i < req->crypto.n_ciphers_pairwise; i++) { |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4308 | if (req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_WEP40 || |
| 4309 | req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_TKIP || |
Johannes Berg | 1c4cb92 | 2012-05-30 15:57:00 +0200 | [diff] [blame] | 4310 | req->crypto.ciphers_pairwise[i] == WLAN_CIPHER_SUITE_WEP104) { |
Johannes Berg | a8243b7 | 2012-11-22 14:32:09 +0100 | [diff] [blame] | 4311 | ifmgd->flags |= IEEE80211_STA_DISABLE_HT; |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4312 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
Johannes Berg | 1c4cb92 | 2012-05-30 15:57:00 +0200 | [diff] [blame] | 4313 | netdev_info(sdata->dev, |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4314 | "disabling HT/VHT due to WEP/TKIP use\n"); |
Johannes Berg | 1c4cb92 | 2012-05-30 15:57:00 +0200 | [diff] [blame] | 4315 | } |
| 4316 | } |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4317 | |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4318 | if (req->flags & ASSOC_REQ_DISABLE_HT) { |
Johannes Berg | a8243b7 | 2012-11-22 14:32:09 +0100 | [diff] [blame] | 4319 | ifmgd->flags |= IEEE80211_STA_DISABLE_HT; |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4320 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
| 4321 | } |
Ben Greear | ef96a842 | 2011-11-18 11:32:00 -0800 | [diff] [blame] | 4322 | |
Johannes Berg | dd5ecfe | 2013-02-21 17:40:19 +0100 | [diff] [blame] | 4323 | if (req->flags & ASSOC_REQ_DISABLE_VHT) |
| 4324 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
| 4325 | |
Johannes Berg | 4e74bfd | 2012-03-08 15:02:04 +0100 | [diff] [blame] | 4326 | /* Also disable HT if we don't support it or the AP doesn't use WMM */ |
| 4327 | sband = local->hw.wiphy->bands[req->bss->channel->band]; |
| 4328 | if (!sband->ht_cap.ht_supported || |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4329 | local->hw.queues < IEEE80211_NUM_ACS || !bss->wmm_used || |
| 4330 | ifmgd->flags & IEEE80211_STA_DISABLE_WMM) { |
Johannes Berg | a8243b7 | 2012-11-22 14:32:09 +0100 | [diff] [blame] | 4331 | ifmgd->flags |= IEEE80211_STA_DISABLE_HT; |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4332 | if (!bss->wmm_used && |
| 4333 | !(ifmgd->flags & IEEE80211_STA_DISABLE_WMM)) |
Johannes Berg | 1b49de2 | 2012-07-27 10:29:14 +0200 | [diff] [blame] | 4334 | netdev_info(sdata->dev, |
| 4335 | "disabling HT as WMM/QoS is not supported by the AP\n"); |
Johannes Berg | 1c4cb92 | 2012-05-30 15:57:00 +0200 | [diff] [blame] | 4336 | } |
Johannes Berg | 4e74bfd | 2012-03-08 15:02:04 +0100 | [diff] [blame] | 4337 | |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4338 | /* disable VHT if we don't support it or the AP doesn't use WMM */ |
| 4339 | if (!sband->vht_cap.vht_supported || |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4340 | local->hw.queues < IEEE80211_NUM_ACS || !bss->wmm_used || |
| 4341 | ifmgd->flags & IEEE80211_STA_DISABLE_WMM) { |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4342 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
Johannes Berg | 095d81c | 2013-10-15 12:25:07 +0200 | [diff] [blame] | 4343 | if (!bss->wmm_used && |
| 4344 | !(ifmgd->flags & IEEE80211_STA_DISABLE_WMM)) |
Johannes Berg | 1b49de2 | 2012-07-27 10:29:14 +0200 | [diff] [blame] | 4345 | netdev_info(sdata->dev, |
| 4346 | "disabling VHT as WMM/QoS is not supported by the AP\n"); |
Mahesh Palivela | d545dab | 2012-07-24 03:33:10 +0000 | [diff] [blame] | 4347 | } |
| 4348 | |
Ben Greear | ef96a842 | 2011-11-18 11:32:00 -0800 | [diff] [blame] | 4349 | memcpy(&ifmgd->ht_capa, &req->ht_capa, sizeof(ifmgd->ht_capa)); |
| 4350 | memcpy(&ifmgd->ht_capa_mask, &req->ht_capa_mask, |
| 4351 | sizeof(ifmgd->ht_capa_mask)); |
| 4352 | |
Johannes Berg | dd5ecfe | 2013-02-21 17:40:19 +0100 | [diff] [blame] | 4353 | memcpy(&ifmgd->vht_capa, &req->vht_capa, sizeof(ifmgd->vht_capa)); |
| 4354 | memcpy(&ifmgd->vht_capa_mask, &req->vht_capa_mask, |
| 4355 | sizeof(ifmgd->vht_capa_mask)); |
| 4356 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4357 | if (req->ie && req->ie_len) { |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4358 | memcpy(assoc_data->ie, req->ie, req->ie_len); |
| 4359 | assoc_data->ie_len = req->ie_len; |
| 4360 | } |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4361 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4362 | assoc_data->bss = req->bss; |
Johannes Berg | f679f65 | 2009-12-23 13:15:34 +0100 | [diff] [blame] | 4363 | |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4364 | if (ifmgd->req_smps == IEEE80211_SMPS_AUTOMATIC) { |
| 4365 | if (ifmgd->powersave) |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 4366 | sdata->smps_mode = IEEE80211_SMPS_DYNAMIC; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4367 | else |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 4368 | sdata->smps_mode = IEEE80211_SMPS_OFF; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4369 | } else |
Johannes Berg | 04ecd25 | 2012-09-11 14:34:12 +0200 | [diff] [blame] | 4370 | sdata->smps_mode = ifmgd->req_smps; |
Johannes Berg | af6b637 | 2009-12-23 13:15:35 +0100 | [diff] [blame] | 4371 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4372 | assoc_data->capability = req->bss->capability; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4373 | assoc_data->supp_rates = bss->supp_rates; |
| 4374 | assoc_data->supp_rates_len = bss->supp_rates_len; |
Johannes Berg | 9dde642 | 2012-05-16 23:43:19 +0200 | [diff] [blame] | 4375 | |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 4376 | rcu_read_lock(); |
Johannes Berg | 9dde642 | 2012-05-16 23:43:19 +0200 | [diff] [blame] | 4377 | ht_ie = ieee80211_bss_get_ie(req->bss, WLAN_EID_HT_OPERATION); |
| 4378 | if (ht_ie && ht_ie[1] >= sizeof(struct ieee80211_ht_operation)) |
| 4379 | assoc_data->ap_ht_param = |
| 4380 | ((struct ieee80211_ht_operation *)(ht_ie + 2))->ht_param; |
| 4381 | else |
Johannes Berg | a8243b7 | 2012-11-22 14:32:09 +0100 | [diff] [blame] | 4382 | ifmgd->flags |= IEEE80211_STA_DISABLE_HT; |
Johannes Berg | b08fbbd | 2012-12-07 13:06:48 +0100 | [diff] [blame] | 4383 | vht_ie = ieee80211_bss_get_ie(req->bss, WLAN_EID_VHT_CAPABILITY); |
| 4384 | if (vht_ie && vht_ie[1] >= sizeof(struct ieee80211_vht_cap)) |
| 4385 | memcpy(&assoc_data->ap_vht_cap, vht_ie + 2, |
| 4386 | sizeof(struct ieee80211_vht_cap)); |
| 4387 | else |
| 4388 | ifmgd->flags |= IEEE80211_STA_DISABLE_VHT; |
Johannes Berg | 9caf036 | 2012-11-29 01:25:20 +0100 | [diff] [blame] | 4389 | rcu_read_unlock(); |
Johannes Berg | 63f170e | 2009-12-23 13:15:33 +0100 | [diff] [blame] | 4390 | |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 4391 | if (bss->wmm_used && bss->uapsd_supported && |
Johannes Berg | bb512ad | 2014-08-25 12:08:09 +0200 | [diff] [blame] | 4392 | (sdata->local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD)) { |
Johannes Berg | 76f0303 | 2012-03-08 15:02:05 +0100 | [diff] [blame] | 4393 | assoc_data->uapsd = true; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 4394 | ifmgd->flags |= IEEE80211_STA_UAPSD_ENABLED; |
| 4395 | } else { |
Johannes Berg | 76f0303 | 2012-03-08 15:02:05 +0100 | [diff] [blame] | 4396 | assoc_data->uapsd = false; |
Kalle Valo | ab13315 | 2010-01-12 10:42:31 +0200 | [diff] [blame] | 4397 | ifmgd->flags &= ~IEEE80211_STA_UAPSD_ENABLED; |
| 4398 | } |
| 4399 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4400 | if (req->prev_bssid) |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4401 | memcpy(assoc_data->prev_bssid, req->prev_bssid, ETH_ALEN); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4402 | |
| 4403 | if (req->use_mfp) { |
| 4404 | ifmgd->mfp = IEEE80211_MFP_REQUIRED; |
| 4405 | ifmgd->flags |= IEEE80211_STA_MFP_ENABLED; |
| 4406 | } else { |
| 4407 | ifmgd->mfp = IEEE80211_MFP_DISABLED; |
| 4408 | ifmgd->flags &= ~IEEE80211_STA_MFP_ENABLED; |
| 4409 | } |
| 4410 | |
| 4411 | if (req->crypto.control_port) |
| 4412 | ifmgd->flags |= IEEE80211_STA_CONTROL_PORT; |
| 4413 | else |
| 4414 | ifmgd->flags &= ~IEEE80211_STA_CONTROL_PORT; |
| 4415 | |
Johannes Berg | a621fa4 | 2010-08-27 14:26:54 +0300 | [diff] [blame] | 4416 | sdata->control_port_protocol = req->crypto.control_port_ethertype; |
| 4417 | sdata->control_port_no_encrypt = req->crypto.control_port_no_encrypt; |
Max Stepanov | 2475b1cc | 2013-03-24 14:23:27 +0200 | [diff] [blame] | 4418 | sdata->encrypt_headroom = ieee80211_cs_headroom(local, &req->crypto, |
| 4419 | sdata->vif.type); |
Johannes Berg | a621fa4 | 2010-08-27 14:26:54 +0300 | [diff] [blame] | 4420 | |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4421 | /* kick off associate process */ |
| 4422 | |
| 4423 | ifmgd->assoc_data = assoc_data; |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 4424 | ifmgd->dtim_period = 0; |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 4425 | ifmgd->have_beacon = false; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4426 | |
Johannes Berg | a1cf775 | 2012-03-08 15:02:07 +0100 | [diff] [blame] | 4427 | err = ieee80211_prep_connection(sdata, req->bss, true); |
| 4428 | if (err) |
| 4429 | goto err_clear; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4430 | |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4431 | rcu_read_lock(); |
| 4432 | beacon_ies = rcu_dereference(req->bss->beacon_ies); |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 4433 | |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4434 | if (sdata->local->hw.flags & IEEE80211_HW_NEED_DTIM_BEFORE_ASSOC && |
| 4435 | !beacon_ies) { |
| 4436 | /* |
| 4437 | * Wait up to one beacon interval ... |
| 4438 | * should this be more if we miss one? |
| 4439 | */ |
| 4440 | sdata_info(sdata, "waiting for beacon from %pM\n", |
| 4441 | ifmgd->bssid); |
| 4442 | assoc_data->timeout = TU_TO_EXP_TIME(req->bss->beacon_interval); |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 4443 | assoc_data->timeout_started = true; |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4444 | assoc_data->need_beacon = true; |
| 4445 | } else if (beacon_ies) { |
| 4446 | const u8 *tim_ie = cfg80211_find_ie(WLAN_EID_TIM, |
| 4447 | beacon_ies->data, |
| 4448 | beacon_ies->len); |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 4449 | u8 dtim_count = 0; |
| 4450 | |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4451 | if (tim_ie && tim_ie[1] >= sizeof(struct ieee80211_tim_ie)) { |
| 4452 | const struct ieee80211_tim_ie *tim; |
| 4453 | tim = (void *)(tim_ie + 2); |
| 4454 | ifmgd->dtim_period = tim->dtim_period; |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 4455 | dtim_count = tim->dtim_count; |
Johannes Berg | 826262c | 2012-12-10 16:38:14 +0200 | [diff] [blame] | 4456 | } |
Alexander Bondar | 989c650 | 2013-05-16 17:34:17 +0300 | [diff] [blame] | 4457 | ifmgd->have_beacon = true; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4458 | assoc_data->timeout = jiffies; |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 4459 | assoc_data->timeout_started = true; |
Johannes Berg | ef429da | 2013-02-05 17:48:40 +0100 | [diff] [blame] | 4460 | |
| 4461 | if (local->hw.flags & IEEE80211_HW_TIMING_BEACON_ONLY) { |
| 4462 | sdata->vif.bss_conf.sync_tsf = beacon_ies->tsf; |
| 4463 | sdata->vif.bss_conf.sync_device_ts = |
| 4464 | bss->device_ts_beacon; |
| 4465 | sdata->vif.bss_conf.sync_dtim_count = dtim_count; |
| 4466 | } |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4467 | } else { |
| 4468 | assoc_data->timeout = jiffies; |
Johannes Berg | 89afe61 | 2013-02-13 15:39:57 +0100 | [diff] [blame] | 4469 | assoc_data->timeout_started = true; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4470 | } |
Emmanuel Grumbach | c65dd14 | 2012-12-12 10:12:24 +0200 | [diff] [blame] | 4471 | rcu_read_unlock(); |
| 4472 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 4473 | run_again(sdata, assoc_data->timeout); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4474 | |
Paul Stewart | fcff4f1 | 2012-02-23 17:59:53 -0800 | [diff] [blame] | 4475 | if (bss->corrupt_data) { |
| 4476 | char *corrupt_type = "data"; |
| 4477 | if (bss->corrupt_data & IEEE80211_BSS_CORRUPT_BEACON) { |
| 4478 | if (bss->corrupt_data & |
| 4479 | IEEE80211_BSS_CORRUPT_PROBE_RESP) |
| 4480 | corrupt_type = "beacon and probe response"; |
| 4481 | else |
| 4482 | corrupt_type = "beacon"; |
| 4483 | } else if (bss->corrupt_data & IEEE80211_BSS_CORRUPT_PROBE_RESP) |
| 4484 | corrupt_type = "probe response"; |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 4485 | sdata_info(sdata, "associating with AP with corrupt %s\n", |
| 4486 | corrupt_type); |
Paul Stewart | fcff4f1 | 2012-02-23 17:59:53 -0800 | [diff] [blame] | 4487 | } |
| 4488 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 4489 | return 0; |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4490 | err_clear: |
Eliad Peller | 3d2abdf | 2012-09-04 17:44:45 +0300 | [diff] [blame] | 4491 | memset(ifmgd->bssid, 0, ETH_ALEN); |
| 4492 | ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BSSID); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4493 | ifmgd->assoc_data = NULL; |
| 4494 | err_free: |
| 4495 | kfree(assoc_data); |
Johannes Berg | 66e67e4 | 2012-01-20 13:55:27 +0100 | [diff] [blame] | 4496 | return err; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4497 | } |
| 4498 | |
| 4499 | int ieee80211_mgd_deauth(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 63c9c5e | 2012-02-24 13:50:51 +0100 | [diff] [blame] | 4500 | struct cfg80211_deauth_request *req) |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4501 | { |
| 4502 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Antonio Quartulli | 6ae1677 | 2012-09-07 13:28:52 +0200 | [diff] [blame] | 4503 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
Stanislaw Gruszka | 6863255 | 2012-10-15 14:52:41 +0200 | [diff] [blame] | 4504 | bool tx = !req->local_state_change; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4505 | |
Johannes Berg | c9c3a06 | 2014-03-19 09:11:19 +0100 | [diff] [blame] | 4506 | if (ifmgd->auth_data && |
| 4507 | ether_addr_equal(ifmgd->auth_data->bss->bssid, req->bssid)) { |
| 4508 | sdata_info(sdata, |
| 4509 | "aborting authentication with %pM by local choice (Reason: %u=%s)\n", |
| 4510 | req->bssid, req->reason_code, |
| 4511 | ieee80211_get_reason_code_string(req->reason_code)); |
Johannes Berg | 0ff7161 | 2009-09-26 14:45:41 +0200 | [diff] [blame] | 4512 | |
Emmanuel Grumbach | 8c7d857 | 2012-07-25 01:42:36 +0300 | [diff] [blame] | 4513 | drv_mgd_prepare_tx(sdata->local, sdata); |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 4514 | ieee80211_send_deauth_disassoc(sdata, req->bssid, |
| 4515 | IEEE80211_STYPE_DEAUTH, |
Stanislaw Gruszka | 6863255 | 2012-10-15 14:52:41 +0200 | [diff] [blame] | 4516 | req->reason_code, tx, |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 4517 | frame_buf); |
Johannes Berg | 8655201 | 2012-10-29 09:46:31 +0100 | [diff] [blame] | 4518 | ieee80211_destroy_auth_data(sdata, false); |
Johannes Berg | c9c3a06 | 2014-03-19 09:11:19 +0100 | [diff] [blame] | 4519 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 4520 | IEEE80211_DEAUTH_FRAME_LEN); |
Johannes Berg | 8655201 | 2012-10-29 09:46:31 +0100 | [diff] [blame] | 4521 | |
Johannes Berg | c9c3a06 | 2014-03-19 09:11:19 +0100 | [diff] [blame] | 4522 | return 0; |
Emmanuel Grumbach | 8c7d857 | 2012-07-25 01:42:36 +0300 | [diff] [blame] | 4523 | } |
| 4524 | |
Johannes Berg | 8655201 | 2012-10-29 09:46:31 +0100 | [diff] [blame] | 4525 | if (ifmgd->associated && |
| 4526 | ether_addr_equal(ifmgd->associated->bssid, req->bssid)) { |
Johannes Berg | c9c3a06 | 2014-03-19 09:11:19 +0100 | [diff] [blame] | 4527 | sdata_info(sdata, |
| 4528 | "deauthenticating from %pM by local choice (Reason: %u=%s)\n", |
| 4529 | req->bssid, req->reason_code, |
| 4530 | ieee80211_get_reason_code_string(req->reason_code)); |
| 4531 | |
Johannes Berg | 8655201 | 2012-10-29 09:46:31 +0100 | [diff] [blame] | 4532 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DEAUTH, |
| 4533 | req->reason_code, tx, frame_buf); |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 4534 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 4535 | IEEE80211_DEAUTH_FRAME_LEN); |
Johannes Berg | c9c3a06 | 2014-03-19 09:11:19 +0100 | [diff] [blame] | 4536 | return 0; |
| 4537 | } |
Johannes Berg | 8655201 | 2012-10-29 09:46:31 +0100 | [diff] [blame] | 4538 | |
Johannes Berg | c9c3a06 | 2014-03-19 09:11:19 +0100 | [diff] [blame] | 4539 | return -ENOTCONN; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4540 | } |
| 4541 | |
| 4542 | int ieee80211_mgd_disassoc(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 63c9c5e | 2012-02-24 13:50:51 +0100 | [diff] [blame] | 4543 | struct cfg80211_disassoc_request *req) |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4544 | { |
| 4545 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
Jouni Malinen | e69e95d | 2010-03-29 23:29:31 -0700 | [diff] [blame] | 4546 | u8 bssid[ETH_ALEN]; |
Antonio Quartulli | 6ae1677 | 2012-09-07 13:28:52 +0200 | [diff] [blame] | 4547 | u8 frame_buf[IEEE80211_DEAUTH_FRAME_LEN]; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4548 | |
Johannes Berg | 8d8b261 | 2009-07-25 11:58:36 +0200 | [diff] [blame] | 4549 | /* |
| 4550 | * cfg80211 should catch this ... but it's racy since |
| 4551 | * we can receive a disassoc frame, process it, hand it |
| 4552 | * to cfg80211 while that's in a locked section already |
| 4553 | * trying to tell us that the user wants to disconnect. |
| 4554 | */ |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 4555 | if (ifmgd->associated != req->bss) |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4556 | return -ENOLINK; |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4557 | |
Johannes Berg | bdcbd8e | 2012-06-22 11:29:50 +0200 | [diff] [blame] | 4558 | sdata_info(sdata, |
Calvin Owens | dfa1ad2 | 2014-02-11 12:36:24 -0600 | [diff] [blame] | 4559 | "disassociating from %pM by local choice (Reason: %u=%s)\n", |
| 4560 | req->bss->bssid, req->reason_code, ieee80211_get_reason_code_string(req->reason_code)); |
Johannes Berg | 0ff7161 | 2009-09-26 14:45:41 +0200 | [diff] [blame] | 4561 | |
Jouni Malinen | e69e95d | 2010-03-29 23:29:31 -0700 | [diff] [blame] | 4562 | memcpy(bssid, req->bss->bssid, ETH_ALEN); |
Johannes Berg | 37ad388 | 2012-02-24 13:50:54 +0100 | [diff] [blame] | 4563 | ieee80211_set_disassoc(sdata, IEEE80211_STYPE_DISASSOC, |
| 4564 | req->reason_code, !req->local_state_change, |
| 4565 | frame_buf); |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4566 | |
Johannes Berg | 6ff57cf | 2013-05-16 00:55:00 +0200 | [diff] [blame] | 4567 | cfg80211_tx_mlme_mgmt(sdata->dev, frame_buf, |
| 4568 | IEEE80211_DEAUTH_FRAME_LEN); |
Johannes Berg | bc83b68 | 2009-11-29 12:19:06 +0100 | [diff] [blame] | 4569 | |
Johannes Berg | 77fdaa1 | 2009-07-07 03:45:17 +0200 | [diff] [blame] | 4570 | return 0; |
| 4571 | } |
Jouni Malinen | 026331c | 2010-02-15 12:53:10 +0200 | [diff] [blame] | 4572 | |
Eliad Peller | afa762f | 2012-04-23 14:45:15 +0300 | [diff] [blame] | 4573 | void ieee80211_mgd_stop(struct ieee80211_sub_if_data *sdata) |
Johannes Berg | 54e4ffb | 2012-02-25 21:48:08 +0100 | [diff] [blame] | 4574 | { |
| 4575 | struct ieee80211_if_managed *ifmgd = &sdata->u.mgd; |
| 4576 | |
Ben Greear | 4992185 | 2013-02-20 09:41:09 -0800 | [diff] [blame] | 4577 | /* |
| 4578 | * Make sure some work items will not run after this, |
| 4579 | * they will not do anything but might not have been |
| 4580 | * cancelled when disconnecting. |
| 4581 | */ |
| 4582 | cancel_work_sync(&ifmgd->monitor_work); |
| 4583 | cancel_work_sync(&ifmgd->beacon_connection_loss_work); |
| 4584 | cancel_work_sync(&ifmgd->request_smps_work); |
| 4585 | cancel_work_sync(&ifmgd->csa_connection_drop_work); |
| 4586 | cancel_work_sync(&ifmgd->chswitch_work); |
Arik Nemtsov | 81dd2b8 | 2014-07-17 17:14:25 +0300 | [diff] [blame] | 4587 | cancel_delayed_work_sync(&ifmgd->tdls_peer_del_work); |
Ben Greear | 4992185 | 2013-02-20 09:41:09 -0800 | [diff] [blame] | 4588 | |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 4589 | sdata_lock(sdata); |
Johannes Berg | 959867f | 2013-06-19 13:05:42 +0200 | [diff] [blame] | 4590 | if (ifmgd->assoc_data) { |
| 4591 | struct cfg80211_bss *bss = ifmgd->assoc_data->bss; |
Johannes Berg | 54e4ffb | 2012-02-25 21:48:08 +0100 | [diff] [blame] | 4592 | ieee80211_destroy_assoc_data(sdata, false); |
Johannes Berg | 959867f | 2013-06-19 13:05:42 +0200 | [diff] [blame] | 4593 | cfg80211_assoc_timeout(sdata->dev, bss); |
| 4594 | } |
Johannes Berg | 54e4ffb | 2012-02-25 21:48:08 +0100 | [diff] [blame] | 4595 | if (ifmgd->auth_data) |
| 4596 | ieee80211_destroy_auth_data(sdata, false); |
| 4597 | del_timer_sync(&ifmgd->timer); |
Johannes Berg | 8d61ffa | 2013-05-10 12:32:47 +0200 | [diff] [blame] | 4598 | sdata_unlock(sdata); |
Johannes Berg | 54e4ffb | 2012-02-25 21:48:08 +0100 | [diff] [blame] | 4599 | } |
| 4600 | |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 4601 | void ieee80211_cqm_rssi_notify(struct ieee80211_vif *vif, |
| 4602 | enum nl80211_cqm_rssi_threshold_event rssi_event, |
| 4603 | gfp_t gfp) |
| 4604 | { |
| 4605 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
| 4606 | |
Johannes Berg | b5878a2 | 2010-04-07 16:48:40 +0200 | [diff] [blame] | 4607 | trace_api_cqm_rssi_notify(sdata, rssi_event); |
| 4608 | |
Juuso Oikarinen | a97c13c | 2010-03-23 09:02:34 +0200 | [diff] [blame] | 4609 | cfg80211_cqm_rssi_notify(sdata->dev, rssi_event, gfp); |
| 4610 | } |
| 4611 | EXPORT_SYMBOL(ieee80211_cqm_rssi_notify); |