blob: 95b986238e57308c6b8a218a4bb3c0d7cf5cc76d [file] [log] [blame]
Johannes Berg8ca151b2013-01-24 14:25:36 +01001/******************************************************************************
2 *
3 * This file is provided under a dual BSD/GPLv2 license. When using or
4 * redistributing this file, you may do so under either license.
5 *
6 * GPL LICENSE SUMMARY
7 *
Emmanuel Grumbach51368bf2013-12-30 13:15:54 +02008 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
Luciano Coelho9af91f42015-02-10 10:42:26 +02009 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
Johannes Berg8ca151b2013-01-24 14:25:36 +010010 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of version 2 of the GNU General Public License as
13 * published by the Free Software Foundation.
14 *
15 * This program is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
23 * USA
24 *
25 * The full GNU General Public License is included in this distribution
Emmanuel Grumbach410dc5a2013-02-18 09:22:28 +020026 * in the file called COPYING.
Johannes Berg8ca151b2013-01-24 14:25:36 +010027 *
28 * Contact Information:
29 * Intel Linux Wireless <ilw@linux.intel.com>
30 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
31 *
32 * BSD LICENSE
33 *
Emmanuel Grumbach51368bf2013-12-30 13:15:54 +020034 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
Luciano Coelho9af91f42015-02-10 10:42:26 +020035 * Copyright(c) 2013 - 2015 Intel Mobile Communications GmbH
Johannes Berg8ca151b2013-01-24 14:25:36 +010036 * All rights reserved.
37 *
38 * Redistribution and use in source and binary forms, with or without
39 * modification, are permitted provided that the following conditions
40 * are met:
41 *
42 * * Redistributions of source code must retain the above copyright
43 * notice, this list of conditions and the following disclaimer.
44 * * Redistributions in binary form must reproduce the above copyright
45 * notice, this list of conditions and the following disclaimer in
46 * the documentation and/or other materials provided with the
47 * distribution.
48 * * Neither the name Intel Corporation nor the names of its
49 * contributors may be used to endorse or promote products derived
50 * from this software without specific prior written permission.
51 *
52 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
53 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
54 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
55 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
56 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
57 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
58 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
59 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
60 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
61 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
62 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
63 *
64 *****************************************************************************/
65
66#include <linux/etherdevice.h>
67#include <net/mac80211.h>
68
69#include "mvm.h"
70#include "iwl-eeprom-parse.h"
71#include "fw-api-scan.h"
72
73#define IWL_PLCP_QUIET_THRESH 1
74#define IWL_ACTIVE_QUIET_TIME 10
Haim Dreyfussa1ed4022014-12-01 23:30:07 +020075#define IWL_DENSE_EBS_SCAN_RATIO 5
76#define IWL_SPARSE_EBS_SCAN_RATIO 1
Alexander Bondar8a110d92014-03-12 17:31:19 +020077
78struct iwl_mvm_scan_params {
79 u32 max_out_time;
80 u32 suspend_time;
Alexander Bondar50df8a32014-03-12 20:30:51 +020081 bool passive_fragmented;
82 struct _dwell {
83 u16 passive;
84 u16 active;
David Spinadel190f1022015-02-17 12:45:21 +020085 u16 fragmented;
Alexander Bondar50df8a32014-03-12 20:30:51 +020086 } dwell[IEEE80211_NUM_BANDS];
Alexander Bondar8a110d92014-03-12 17:31:19 +020087};
Johannes Berg8ca151b2013-01-24 14:25:36 +010088
David Spinadeld2496222014-05-20 12:46:37 +030089enum iwl_umac_scan_uid_type {
90 IWL_UMAC_SCAN_UID_REG_SCAN = BIT(0),
91 IWL_UMAC_SCAN_UID_SCHED_SCAN = BIT(1),
92 IWL_UMAC_SCAN_UID_ALL = IWL_UMAC_SCAN_UID_REG_SCAN |
93 IWL_UMAC_SCAN_UID_SCHED_SCAN,
94};
95
96static int iwl_umac_scan_stop(struct iwl_mvm *mvm,
97 enum iwl_umac_scan_uid_type type, bool notify);
98
99static u8 iwl_mvm_scan_rx_ant(struct iwl_mvm *mvm)
100{
101 if (mvm->scan_rx_ant != ANT_NONE)
102 return mvm->scan_rx_ant;
Moshe Harela0544272014-12-08 21:13:14 +0200103 return iwl_mvm_get_valid_rx_ant(mvm);
David Spinadeld2496222014-05-20 12:46:37 +0300104}
105
Johannes Berg8ca151b2013-01-24 14:25:36 +0100106static inline __le16 iwl_mvm_scan_rx_chain(struct iwl_mvm *mvm)
107{
108 u16 rx_chain;
Oren Givon91b05d12013-08-19 08:36:48 +0300109 u8 rx_ant;
Johannes Berg8ca151b2013-01-24 14:25:36 +0100110
David Spinadeld2496222014-05-20 12:46:37 +0300111 rx_ant = iwl_mvm_scan_rx_ant(mvm);
Johannes Berg8ca151b2013-01-24 14:25:36 +0100112 rx_chain = rx_ant << PHY_RX_CHAIN_VALID_POS;
113 rx_chain |= rx_ant << PHY_RX_CHAIN_FORCE_MIMO_SEL_POS;
114 rx_chain |= rx_ant << PHY_RX_CHAIN_FORCE_SEL_POS;
115 rx_chain |= 0x1 << PHY_RX_CHAIN_DRIVER_FORCE_POS;
116 return cpu_to_le16(rx_chain);
117}
118
David Spinadelfb98be52014-05-04 12:51:10 +0300119static __le32 iwl_mvm_scan_rxon_flags(enum ieee80211_band band)
Johannes Berg8ca151b2013-01-24 14:25:36 +0100120{
David Spinadelfb98be52014-05-04 12:51:10 +0300121 if (band == IEEE80211_BAND_2GHZ)
Johannes Berg8ca151b2013-01-24 14:25:36 +0100122 return cpu_to_le32(PHY_BAND_24);
123 else
124 return cpu_to_le32(PHY_BAND_5);
125}
126
127static inline __le32
128iwl_mvm_scan_rate_n_flags(struct iwl_mvm *mvm, enum ieee80211_band band,
129 bool no_cck)
130{
131 u32 tx_ant;
132
133 mvm->scan_last_antenna_idx =
Moshe Harela0544272014-12-08 21:13:14 +0200134 iwl_mvm_next_antenna(mvm, iwl_mvm_get_valid_tx_ant(mvm),
Johannes Berg8ca151b2013-01-24 14:25:36 +0100135 mvm->scan_last_antenna_idx);
136 tx_ant = BIT(mvm->scan_last_antenna_idx) << RATE_MCS_ANT_POS;
137
138 if (band == IEEE80211_BAND_2GHZ && !no_cck)
139 return cpu_to_le32(IWL_RATE_1M_PLCP | RATE_MCS_CCK_MSK |
140 tx_ant);
141 else
142 return cpu_to_le32(IWL_RATE_6M_PLCP | tx_ant);
143}
144
145/*
146 * We insert the SSIDs in an inverted order, because the FW will
147 * invert it back. The most prioritized SSID, which is first in the
148 * request list, is not copied here, but inserted directly to the probe
149 * request.
150 */
David Spinadelfb98be52014-05-04 12:51:10 +0300151static void iwl_mvm_scan_fill_ssids(struct iwl_ssid_ie *cmd_ssid,
152 struct cfg80211_ssid *ssids,
153 int n_ssids, int first)
Johannes Berg8ca151b2013-01-24 14:25:36 +0100154{
155 int fw_idx, req_idx;
156
David Spinadelfb98be52014-05-04 12:51:10 +0300157 for (req_idx = n_ssids - 1, fw_idx = 0; req_idx >= first;
David Spinadelfe04e832013-07-04 15:17:48 +0300158 req_idx--, fw_idx++) {
David Spinadelfb98be52014-05-04 12:51:10 +0300159 cmd_ssid[fw_idx].id = WLAN_EID_SSID;
160 cmd_ssid[fw_idx].len = ssids[req_idx].ssid_len;
161 memcpy(cmd_ssid[fw_idx].ssid,
162 ssids[req_idx].ssid,
163 ssids[req_idx].ssid_len);
Johannes Berg8ca151b2013-01-24 14:25:36 +0100164 }
165}
166
167/*
168 * If req->n_ssids > 0, it means we should do an active scan.
169 * In case of active scan w/o directed scan, we receive a zero-length SSID
170 * just to notify that this scan is active and not passive.
171 * In order to notify the FW of the number of SSIDs we wish to scan (including
172 * the zero-length one), we need to set the corresponding bits in chan->type,
David Spinadel20f1a5d2013-08-21 09:14:27 +0300173 * one for each SSID, and set the active bit (first). If the first SSID is
174 * already included in the probe template, so we need to set only
175 * req->n_ssids - 1 bits in addition to the first bit.
Johannes Berg8ca151b2013-01-24 14:25:36 +0100176 */
David Spinadel3cae0732014-12-29 15:43:48 +0200177static u16 iwl_mvm_get_active_dwell(struct iwl_mvm *mvm,
178 enum ieee80211_band band, int n_ssids)
Johannes Berg8ca151b2013-01-24 14:25:36 +0100179{
David Spinadel3cae0732014-12-29 15:43:48 +0200180 if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BASIC_DWELL)
181 return 10;
Johannes Berg8ca151b2013-01-24 14:25:36 +0100182 if (band == IEEE80211_BAND_2GHZ)
David Spinadel39745332014-09-10 16:40:41 +0300183 return 20 + 3 * (n_ssids + 1);
184 return 10 + 2 * (n_ssids + 1);
Johannes Berg8ca151b2013-01-24 14:25:36 +0100185}
186
David Spinadel3cae0732014-12-29 15:43:48 +0200187static u16 iwl_mvm_get_passive_dwell(struct iwl_mvm *mvm,
188 enum ieee80211_band band)
Johannes Berg8ca151b2013-01-24 14:25:36 +0100189{
David Spinadel3cae0732014-12-29 15:43:48 +0200190 if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BASIC_DWELL)
191 return 110;
Johannes Berg8ca151b2013-01-24 14:25:36 +0100192 return band == IEEE80211_BAND_2GHZ ? 100 + 20 : 100 + 10;
193}
194
Alexander Bondar8a110d92014-03-12 17:31:19 +0200195static void iwl_mvm_scan_condition_iterator(void *data, u8 *mac,
196 struct ieee80211_vif *vif)
Haim Dreyfuss61f63252013-11-03 23:02:59 +0200197{
Alexander Bondar8a110d92014-03-12 17:31:19 +0200198 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
Haim Dreyfussc3f8d0a2014-12-02 11:03:16 +0200199 int *global_cnt = data;
Haim Dreyfuss61f63252013-11-03 23:02:59 +0200200
David Spinadel1e2ebe02014-10-26 15:53:27 +0200201 if (vif->type != NL80211_IFTYPE_P2P_DEVICE && mvmvif->phy_ctxt &&
202 mvmvif->phy_ctxt->id < MAX_PHYS)
Haim Dreyfussc3f8d0a2014-12-02 11:03:16 +0200203 *global_cnt += 1;
Alexander Bondar8a110d92014-03-12 17:31:19 +0200204}
205
206static void iwl_mvm_scan_calc_params(struct iwl_mvm *mvm,
Alexander Bondar50df8a32014-03-12 20:30:51 +0200207 struct ieee80211_vif *vif,
Johannes Bergab480032014-06-04 10:13:50 +0200208 int n_ssids, u32 flags,
Alexander Bondar8a110d92014-03-12 17:31:19 +0200209 struct iwl_mvm_scan_params *params)
210{
Haim Dreyfussc3f8d0a2014-12-02 11:03:16 +0200211 int global_cnt = 0;
Alexander Bondar50df8a32014-03-12 20:30:51 +0200212 enum ieee80211_band band;
David Spinadel2ce89cd2014-07-22 13:11:18 +0300213 u8 frag_passive_dwell = 0;
Alexander Bondar8a110d92014-03-12 17:31:19 +0200214
215 ieee80211_iterate_active_interfaces_atomic(mvm->hw,
216 IEEE80211_IFACE_ITER_NORMAL,
217 iwl_mvm_scan_condition_iterator,
Haim Dreyfussc3f8d0a2014-12-02 11:03:16 +0200218 &global_cnt);
Alexander Bondar8a110d92014-03-12 17:31:19 +0200219
Haim Dreyfussc3f8d0a2014-12-02 11:03:16 +0200220 if (!global_cnt)
Alexander Bondaref67f18d2014-03-30 10:47:08 +0300221 goto not_bound;
222
David Spinadel2ce89cd2014-07-22 13:11:18 +0300223 params->suspend_time = 30;
Haim Dreyfuss44e9cd72014-12-18 12:34:01 +0200224 params->max_out_time = 120;
Alexander Bondaref67f18d2014-03-30 10:47:08 +0300225
226 if (iwl_mvm_low_latency(mvm)) {
David Spinadel2ce89cd2014-07-22 13:11:18 +0300227 if (mvm->fw->ucode_capa.api[0] &
228 IWL_UCODE_TLV_API_FRAGMENTED_SCAN) {
229 params->suspend_time = 105;
Haim Dreyfussc3f8d0a2014-12-02 11:03:16 +0200230 /*
231 * If there is more than one active interface make
232 * passive scan more fragmented.
233 */
David Spinadelef177082015-02-15 14:45:33 +0200234 frag_passive_dwell = 40;
Haim Dreyfuss44e9cd72014-12-18 12:34:01 +0200235 params->max_out_time = frag_passive_dwell;
David Spinadel2ce89cd2014-07-22 13:11:18 +0300236 } else {
237 params->suspend_time = 120;
238 params->max_out_time = 120;
239 }
240 }
241
242 if (frag_passive_dwell && (mvm->fw->ucode_capa.api[0] &
243 IWL_UCODE_TLV_API_FRAGMENTED_SCAN)) {
244 /*
245 * P2P device scan should not be fragmented to avoid negative
246 * impact on P2P device discovery. Configure max_out_time to be
247 * equal to dwell time on passive channel. Take a longest
248 * possible value, one that corresponds to 2GHz band
249 */
250 if (vif->type == NL80211_IFTYPE_P2P_DEVICE) {
251 u32 passive_dwell =
David Spinadel3cae0732014-12-29 15:43:48 +0200252 iwl_mvm_get_passive_dwell(mvm,
253 IEEE80211_BAND_2GHZ);
David Spinadel2ce89cd2014-07-22 13:11:18 +0300254 params->max_out_time = passive_dwell;
255 } else {
256 params->passive_fragmented = true;
257 }
Alexander Bondar50df8a32014-03-12 20:30:51 +0200258 }
259
Luciano Coelhoc1537662015-04-09 14:48:11 +0300260 if ((flags & NL80211_SCAN_FLAG_LOW_PRIORITY) &&
261 (params->max_out_time > 200))
Johannes Bergab480032014-06-04 10:13:50 +0200262 params->max_out_time = 200;
263
Alexander Bondaref67f18d2014-03-30 10:47:08 +0300264not_bound:
265
Alexander Bondar50df8a32014-03-12 20:30:51 +0200266 for (band = IEEE80211_BAND_2GHZ; band < IEEE80211_NUM_BANDS; band++) {
David Spinadel2ce89cd2014-07-22 13:11:18 +0300267 if (params->passive_fragmented)
David Spinadel190f1022015-02-17 12:45:21 +0200268 params->dwell[band].fragmented = frag_passive_dwell;
269
270 params->dwell[band].passive = iwl_mvm_get_passive_dwell(mvm,
271 band);
David Spinadel3cae0732014-12-29 15:43:48 +0200272 params->dwell[band].active = iwl_mvm_get_active_dwell(mvm, band,
Alexander Bondar50df8a32014-03-12 20:30:51 +0200273 n_ssids);
274 }
Luciano Coelho0616c622015-04-09 12:18:56 +0300275
276 IWL_DEBUG_SCAN(mvm,
277 "scan parameters: max_out_time %d, suspend_time %d, passive_fragmented %d\n",
278 params->max_out_time, params->suspend_time,
279 params->passive_fragmented);
280 IWL_DEBUG_SCAN(mvm,
281 "dwell[IEEE80211_BAND_2GHZ]: passive %d, active %d, fragmented %d\n",
282 params->dwell[IEEE80211_BAND_2GHZ].passive,
283 params->dwell[IEEE80211_BAND_2GHZ].active,
284 params->dwell[IEEE80211_BAND_2GHZ].fragmented);
285 IWL_DEBUG_SCAN(mvm,
286 "dwell[IEEE80211_BAND_5GHZ]: passive %d, active %d, fragmented %d\n",
287 params->dwell[IEEE80211_BAND_5GHZ].passive,
288 params->dwell[IEEE80211_BAND_5GHZ].active,
289 params->dwell[IEEE80211_BAND_5GHZ].fragmented);
Haim Dreyfuss61f63252013-11-03 23:02:59 +0200290}
291
Andrei Otcheretianski73897bd2014-07-09 18:59:14 +0300292static inline bool iwl_mvm_rrm_scan_needed(struct iwl_mvm *mvm)
293{
294 /* require rrm scan whenever the fw supports it */
295 return mvm->fw->ucode_capa.capa[0] &
296 IWL_UCODE_TLV_CAPA_DS_PARAM_SET_IE_SUPPORT;
297}
298
Luciano Coelho999d2562015-03-27 10:28:26 +0300299static int iwl_mvm_max_scan_ie_fw_cmd_room(struct iwl_mvm *mvm)
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300300{
301 int max_probe_len;
302
Luciano Coelho1f940382015-02-10 13:03:38 +0200303 max_probe_len = SCAN_OFFLOAD_PROBE_REQ_SIZE;
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300304
305 /* we create the 802.11 header and SSID element */
306 max_probe_len -= 24 + 2;
307
Andrei Otcheretianski66dc5272014-09-02 17:55:40 +0300308 /* DS parameter set element is added on 2.4GHZ band if required */
309 if (iwl_mvm_rrm_scan_needed(mvm))
310 max_probe_len -= 3;
311
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300312 return max_probe_len;
313}
314
Luciano Coelho999d2562015-03-27 10:28:26 +0300315int iwl_mvm_max_scan_ie_len(struct iwl_mvm *mvm)
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300316{
Luciano Coelho999d2562015-03-27 10:28:26 +0300317 int max_ie_len = iwl_mvm_max_scan_ie_fw_cmd_room(mvm);
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300318
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300319 /* TODO: [BUG] This function should return the maximum allowed size of
320 * scan IEs, however the LMAC scan api contains both 2GHZ and 5GHZ IEs
321 * in the same command. So the correct implementation of this function
322 * is just iwl_mvm_max_scan_ie_fw_cmd_room() / 2. Currently the scan
323 * command has only 512 bytes and it would leave us with about 240
324 * bytes for scan IEs, which is clearly not enough. So meanwhile
325 * we will report an incorrect value. This may result in a failure to
326 * issue a scan in unified_scan_lmac and unified_sched_scan_lmac
327 * functions with -ENOBUFS, if a large enough probe will be provided.
328 */
329 return max_ie_len;
330}
331
Alexander Bondare5d74642014-12-09 19:15:49 +0200332int iwl_mvm_rx_scan_offload_iter_complete_notif(struct iwl_mvm *mvm,
333 struct iwl_rx_cmd_buffer *rxb,
334 struct iwl_device_cmd *cmd)
335{
336 struct iwl_rx_packet *pkt = rxb_addr(rxb);
Avraham Stern1083fd72015-03-31 16:14:41 +0300337 struct iwl_lmac_scan_complete_notif *notif = (void *)pkt->data;
Alexander Bondare5d74642014-12-09 19:15:49 +0200338
339 IWL_DEBUG_SCAN(mvm,
340 "Scan offload iteration complete: status=0x%x scanned channels=%d\n",
341 notif->status, notif->scanned_channels);
342 return 0;
343}
344
David Spinadelfb98be52014-05-04 12:51:10 +0300345int iwl_mvm_rx_scan_offload_results(struct iwl_mvm *mvm,
346 struct iwl_rx_cmd_buffer *rxb,
347 struct iwl_device_cmd *cmd)
David Spinadel35a000b2013-08-28 09:29:43 +0300348{
David Spinadeld2496222014-05-20 12:46:37 +0300349 IWL_DEBUG_SCAN(mvm, "Scheduled scan results\n");
350 ieee80211_sched_scan_results(mvm->hw);
David Spinadel35a000b2013-08-28 09:29:43 +0300351
352 return 0;
353}
354
David Spinadel35a000b2013-08-28 09:29:43 +0300355int iwl_mvm_rx_scan_offload_complete_notif(struct iwl_mvm *mvm,
356 struct iwl_rx_cmd_buffer *rxb,
357 struct iwl_device_cmd *cmd)
358{
359 struct iwl_rx_packet *pkt = rxb_addr(rxb);
Luciano Coelho9af91f42015-02-10 10:42:26 +0200360 struct iwl_periodic_scan_complete *scan_notif = (void *)pkt->data;
361 bool aborted = (scan_notif->status == IWL_SCAN_OFFLOAD_ABORTED);
362 bool ebs_successful = (scan_notif->ebs_status == IWL_SCAN_EBS_SUCCESS);
David Spinadelfb98be52014-05-04 12:51:10 +0300363
Johannes Berga6623e82014-01-27 15:40:53 +0100364 /* scan status must be locked for proper checking */
365 lockdep_assert_held(&mvm->mutex);
366
Luciano Coelho9af91f42015-02-10 10:42:26 +0200367 /* We first check if we were stopping a scan, in which case we
368 * just clear the stopping flag. Then we check if it was a
369 * firmware initiated stop, in which case we need to inform
370 * mac80211.
371 * Note that we can have a stopping and a running scan
372 * simultaneously, but we can't have two different types of
373 * scans stopping or running at the same time (since LMAC
374 * doesn't support it).
375 */
Haim Dreyfusse820c2d2014-04-06 11:19:09 +0300376
Luciano Coelho9af91f42015-02-10 10:42:26 +0200377 if (mvm->scan_status & IWL_MVM_SCAN_STOPPING_SCHED) {
378 WARN_ON_ONCE(mvm->scan_status & IWL_MVM_SCAN_STOPPING_REGULAR);
David Spinadel35a000b2013-08-28 09:29:43 +0300379
Luciano Coelho9af91f42015-02-10 10:42:26 +0200380 IWL_DEBUG_SCAN(mvm, "Scheduled scan %s, EBS status %s\n",
381 aborted ? "aborted" : "completed",
382 ebs_successful ? "successful" : "failed");
383
384 mvm->scan_status &= ~IWL_MVM_SCAN_STOPPING_SCHED;
385 } else if (mvm->scan_status & IWL_MVM_SCAN_STOPPING_REGULAR) {
386 IWL_DEBUG_SCAN(mvm, "Regular scan %s, EBS status %s\n",
387 aborted ? "aborted" : "completed",
388 ebs_successful ? "successful" : "failed");
389
390 mvm->scan_status &= ~IWL_MVM_SCAN_STOPPING_REGULAR;
391 } else if (mvm->scan_status & IWL_MVM_SCAN_SCHED) {
392 WARN_ON_ONCE(mvm->scan_status & IWL_MVM_SCAN_REGULAR);
393
394 IWL_DEBUG_SCAN(mvm, "Scheduled scan %s, EBS status %s (FW)\n",
395 aborted ? "aborted" : "completed",
396 ebs_successful ? "successful" : "failed");
397
398 mvm->scan_status &= ~IWL_MVM_SCAN_SCHED;
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200399 ieee80211_sched_scan_stopped(mvm->hw);
Luciano Coelho9af91f42015-02-10 10:42:26 +0200400 } else if (mvm->scan_status & IWL_MVM_SCAN_REGULAR) {
401 IWL_DEBUG_SCAN(mvm, "Regular scan %s, EBS status %s (FW)\n",
402 aborted ? "aborted" : "completed",
403 ebs_successful ? "successful" : "failed");
404
405 mvm->scan_status &= ~IWL_MVM_SCAN_REGULAR;
David Spinadelfb98be52014-05-04 12:51:10 +0300406 ieee80211_scan_completed(mvm->hw,
Luciano Coelho1f940382015-02-10 13:03:38 +0200407 scan_notif->status == IWL_SCAN_OFFLOAD_ABORTED);
Eliad Peller4ff78182014-06-22 14:44:44 +0300408 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200409 }
David Spinadel35a000b2013-08-28 09:29:43 +0300410
Luciano Coelho9af91f42015-02-10 10:42:26 +0200411 mvm->last_ebs_successful = ebs_successful;
Haim Dreyfusse820c2d2014-04-06 11:19:09 +0300412
David Spinadel35a000b2013-08-28 09:29:43 +0300413 return 0;
414}
415
David Spinadel35a000b2013-08-28 09:29:43 +0300416static int iwl_ssid_exist(u8 *ssid, u8 ssid_len, struct iwl_ssid_ie *ssid_list)
417{
418 int i;
419
420 for (i = 0; i < PROBE_OPTION_MAX; i++) {
421 if (!ssid_list[i].len)
422 break;
423 if (ssid_list[i].len == ssid_len &&
424 !memcmp(ssid_list->ssid, ssid, ssid_len))
425 return i;
426 }
427 return -1;
428}
429
430static void iwl_scan_offload_build_ssid(struct cfg80211_sched_scan_request *req,
David Spinadelfb98be52014-05-04 12:51:10 +0300431 struct iwl_ssid_ie *direct_scan,
432 u32 *ssid_bitmap, bool basic_ssid)
David Spinadel35a000b2013-08-28 09:29:43 +0300433{
434 int i, j;
435 int index;
436
437 /*
438 * copy SSIDs from match list.
439 * iwl_config_sched_scan_profiles() uses the order of these ssids to
440 * config match list.
441 */
442 for (i = 0; i < req->n_match_sets && i < PROBE_OPTION_MAX; i++) {
Johannes Bergea73cbc2014-01-24 10:53:53 +0100443 /* skip empty SSID matchsets */
444 if (!req->match_sets[i].ssid.ssid_len)
445 continue;
David Spinadelfb98be52014-05-04 12:51:10 +0300446 direct_scan[i].id = WLAN_EID_SSID;
447 direct_scan[i].len = req->match_sets[i].ssid.ssid_len;
448 memcpy(direct_scan[i].ssid, req->match_sets[i].ssid.ssid,
449 direct_scan[i].len);
David Spinadel35a000b2013-08-28 09:29:43 +0300450 }
451
452 /* add SSIDs from scan SSID list */
453 *ssid_bitmap = 0;
454 for (j = 0; j < req->n_ssids && i < PROBE_OPTION_MAX; j++) {
455 index = iwl_ssid_exist(req->ssids[j].ssid,
456 req->ssids[j].ssid_len,
David Spinadelfb98be52014-05-04 12:51:10 +0300457 direct_scan);
David Spinadel35a000b2013-08-28 09:29:43 +0300458 if (index < 0) {
David Spinadelfb98be52014-05-04 12:51:10 +0300459 if (!req->ssids[j].ssid_len && basic_ssid)
David Spinadel35a000b2013-08-28 09:29:43 +0300460 continue;
David Spinadelfb98be52014-05-04 12:51:10 +0300461 direct_scan[i].id = WLAN_EID_SSID;
462 direct_scan[i].len = req->ssids[j].ssid_len;
463 memcpy(direct_scan[i].ssid, req->ssids[j].ssid,
464 direct_scan[i].len);
David Spinadel35a000b2013-08-28 09:29:43 +0300465 *ssid_bitmap |= BIT(i + 1);
466 i++;
467 } else {
468 *ssid_bitmap |= BIT(index + 1);
469 }
470 }
471}
472
David Spinadel35a000b2013-08-28 09:29:43 +0300473int iwl_mvm_config_sched_scan_profiles(struct iwl_mvm *mvm,
474 struct cfg80211_sched_scan_request *req)
475{
476 struct iwl_scan_offload_profile *profile;
477 struct iwl_scan_offload_profile_cfg *profile_cfg;
478 struct iwl_scan_offload_blacklist *blacklist;
479 struct iwl_host_cmd cmd = {
480 .id = SCAN_OFFLOAD_UPDATE_PROFILES_CMD,
David Spinadel35a000b2013-08-28 09:29:43 +0300481 .len[1] = sizeof(*profile_cfg),
482 .dataflags[0] = IWL_HCMD_DFL_NOCOPY,
483 .dataflags[1] = IWL_HCMD_DFL_NOCOPY,
484 };
485 int blacklist_len;
486 int i;
487 int ret;
488
489 if (WARN_ON(req->n_match_sets > IWL_SCAN_MAX_PROFILES))
490 return -EIO;
491
492 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_SHORT_BL)
493 blacklist_len = IWL_SCAN_SHORT_BLACKLIST_LEN;
494 else
495 blacklist_len = IWL_SCAN_MAX_BLACKLIST_LEN;
496
497 blacklist = kzalloc(sizeof(*blacklist) * blacklist_len, GFP_KERNEL);
498 if (!blacklist)
499 return -ENOMEM;
500
501 profile_cfg = kzalloc(sizeof(*profile_cfg), GFP_KERNEL);
502 if (!profile_cfg) {
503 ret = -ENOMEM;
504 goto free_blacklist;
505 }
506
507 cmd.data[0] = blacklist;
508 cmd.len[0] = sizeof(*blacklist) * blacklist_len;
509 cmd.data[1] = profile_cfg;
510
511 /* No blacklist configuration */
512
513 profile_cfg->num_profiles = req->n_match_sets;
514 profile_cfg->active_clients = SCAN_CLIENT_SCHED_SCAN;
515 profile_cfg->pass_match = SCAN_CLIENT_SCHED_SCAN;
516 profile_cfg->match_notify = SCAN_CLIENT_SCHED_SCAN;
David Spinadel6e0bbe52013-12-30 09:59:45 +0200517 if (!req->n_match_sets || !req->match_sets[0].ssid.ssid_len)
518 profile_cfg->any_beacon_notify = SCAN_CLIENT_SCHED_SCAN;
David Spinadel35a000b2013-08-28 09:29:43 +0300519
520 for (i = 0; i < req->n_match_sets; i++) {
521 profile = &profile_cfg->profiles[i];
522 profile->ssid_index = i;
523 /* Support any cipher and auth algorithm */
524 profile->unicast_cipher = 0xff;
525 profile->auth_alg = 0xff;
526 profile->network_type = IWL_NETWORK_TYPE_ANY;
527 profile->band_selection = IWL_SCAN_OFFLOAD_SELECT_ANY;
528 profile->client_bitmap = SCAN_CLIENT_SCHED_SCAN;
529 }
530
531 IWL_DEBUG_SCAN(mvm, "Sending scheduled scan profile config\n");
532
533 ret = iwl_mvm_send_cmd(mvm, &cmd);
534 kfree(profile_cfg);
535free_blacklist:
536 kfree(blacklist);
537
538 return ret;
539}
540
David Spinadeld2496222014-05-20 12:46:37 +0300541static bool iwl_mvm_scan_pass_all(struct iwl_mvm *mvm,
542 struct cfg80211_sched_scan_request *req)
543{
544 if (req->n_match_sets && req->match_sets[0].ssid.ssid_len) {
545 IWL_DEBUG_SCAN(mvm,
546 "Sending scheduled scan with filtering, n_match_sets %d\n",
547 req->n_match_sets);
548 return false;
549 }
550
551 IWL_DEBUG_SCAN(mvm, "Sending Scheduled scan without filtering\n");
552 return true;
553}
554
David Spinadelfb98be52014-05-04 12:51:10 +0300555static int iwl_mvm_send_scan_offload_abort(struct iwl_mvm *mvm)
David Spinadel35a000b2013-08-28 09:29:43 +0300556{
557 int ret;
558 struct iwl_host_cmd cmd = {
559 .id = SCAN_OFFLOAD_ABORT_CMD,
David Spinadel35a000b2013-08-28 09:29:43 +0300560 };
561 u32 status;
562
563 /* Exit instantly with error when device is not ready
564 * to receive scan abort command or it does not perform
565 * scheduled scan currently */
Luciano Coelho9af91f42015-02-10 10:42:26 +0200566 if (!mvm->scan_status)
David Spinadel35a000b2013-08-28 09:29:43 +0300567 return -EIO;
568
569 ret = iwl_mvm_send_cmd_status(mvm, &cmd, &status);
570 if (ret)
571 return ret;
572
573 if (status != CAN_ABORT_STATUS) {
574 /*
575 * The scan abort will return 1 for success or
576 * 2 for "failure". A failure condition can be
577 * due to simply not being in an active scan which
578 * can occur if we send the scan abort before the
579 * microcode has notified us that a scan is completed.
580 */
581 IWL_DEBUG_SCAN(mvm, "SCAN OFFLOAD ABORT ret %d.\n", status);
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200582 ret = -ENOENT;
David Spinadel35a000b2013-08-28 09:29:43 +0300583 }
584
585 return ret;
586}
587
David Spinadelfb98be52014-05-04 12:51:10 +0300588int iwl_mvm_scan_offload_stop(struct iwl_mvm *mvm, bool notify)
David Spinadel35a000b2013-08-28 09:29:43 +0300589{
590 int ret;
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200591 struct iwl_notification_wait wait_scan_done;
592 static const u8 scan_done_notif[] = { SCAN_OFFLOAD_COMPLETE, };
Luciano Coelho9af91f42015-02-10 10:42:26 +0200593 bool sched = !!(mvm->scan_status & IWL_MVM_SCAN_SCHED);
David Spinadel35a000b2013-08-28 09:29:43 +0300594
595 lockdep_assert_held(&mvm->mutex);
596
David Spinadeld2496222014-05-20 12:46:37 +0300597 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)
598 return iwl_umac_scan_stop(mvm, IWL_UMAC_SCAN_UID_SCHED_SCAN,
599 notify);
600
Luciano Coelho9af91f42015-02-10 10:42:26 +0200601 /* FIXME: For now we only check if no scan is set here, since
602 * we only support LMAC in this flow and it doesn't support
603 * multiple scans.
604 */
605 if (!mvm->scan_status)
Emmanuel Grumbach90ea15c2015-01-18 21:39:30 +0200606 return 0;
607
Luciano Coelho54331db2015-02-05 00:39:22 +0200608 if (iwl_mvm_is_radio_killed(mvm)) {
609 ret = 0;
Emmanuel Grumbach90ea15c2015-01-18 21:39:30 +0200610 goto out;
Luciano Coelho54331db2015-02-05 00:39:22 +0200611 }
Emmanuel Grumbach90ea15c2015-01-18 21:39:30 +0200612
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200613 iwl_init_notification_wait(&mvm->notif_wait, &wait_scan_done,
614 scan_done_notif,
615 ARRAY_SIZE(scan_done_notif),
616 NULL, NULL);
617
David Spinadelfb98be52014-05-04 12:51:10 +0300618 ret = iwl_mvm_send_scan_offload_abort(mvm);
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200619 if (ret) {
David Spinadelfb98be52014-05-04 12:51:10 +0300620 IWL_DEBUG_SCAN(mvm, "Send stop %sscan failed %d\n",
621 sched ? "offloaded " : "", ret);
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200622 iwl_remove_notification(&mvm->notif_wait, &wait_scan_done);
Luciano Coelho54331db2015-02-05 00:39:22 +0200623 goto out;
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200624 }
625
David Spinadelfb98be52014-05-04 12:51:10 +0300626 IWL_DEBUG_SCAN(mvm, "Successfully sent stop %sscan\n",
Luciano Coelho9af91f42015-02-10 10:42:26 +0200627 sched ? "scheduled " : "");
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200628
629 ret = iwl_wait_notification(&mvm->notif_wait, &wait_scan_done, 1 * HZ);
Luciano Coelho54331db2015-02-05 00:39:22 +0200630out:
Luciano Coelho9af91f42015-02-10 10:42:26 +0200631 /* Clear the scan status so the next scan requests will
632 * succeed and mark the scan as stopping, so that the Rx
633 * handler doesn't do anything, as the scan was stopped from
634 * above. Since the rx handler won't do anything now, we have
635 * to release the scan reference here.
Arik Nemtsov33ea27f2014-02-10 15:34:29 +0200636 */
Luciano Coelho9af91f42015-02-10 10:42:26 +0200637 if (mvm->scan_status == IWL_MVM_SCAN_REGULAR)
Eliad Peller4ff78182014-06-22 14:44:44 +0300638 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
639
Luciano Coelho9af91f42015-02-10 10:42:26 +0200640 if (sched) {
641 mvm->scan_status &= ~IWL_MVM_SCAN_SCHED;
642 mvm->scan_status |= IWL_MVM_SCAN_STOPPING_SCHED;
643 if (notify)
David Spinadelfb98be52014-05-04 12:51:10 +0300644 ieee80211_sched_scan_stopped(mvm->hw);
Luciano Coelho9af91f42015-02-10 10:42:26 +0200645 } else {
646 mvm->scan_status &= ~IWL_MVM_SCAN_REGULAR;
647 mvm->scan_status |= IWL_MVM_SCAN_STOPPING_REGULAR;
648 if (notify)
David Spinadelfb98be52014-05-04 12:51:10 +0300649 ieee80211_scan_completed(mvm->hw, true);
650 }
David Spinadel636a2cd2014-05-01 15:57:22 +0300651
Luciano Coelho54331db2015-02-05 00:39:22 +0200652 return ret;
David Spinadel35a000b2013-08-28 09:29:43 +0300653}
David Spinadelfb98be52014-05-04 12:51:10 +0300654
Luciano Coelho65ff5562015-03-20 13:35:47 +0200655static void iwl_mvm_scan_fill_tx_cmd(struct iwl_mvm *mvm,
656 struct iwl_scan_req_tx_cmd *tx_cmd,
657 bool no_cck)
David Spinadelfb98be52014-05-04 12:51:10 +0300658{
659 tx_cmd[0].tx_flags = cpu_to_le32(TX_CMD_FLG_SEQ_CTL |
660 TX_CMD_FLG_BT_DIS);
661 tx_cmd[0].rate_n_flags = iwl_mvm_scan_rate_n_flags(mvm,
662 IEEE80211_BAND_2GHZ,
663 no_cck);
664 tx_cmd[0].sta_id = mvm->aux_sta.sta_id;
665
666 tx_cmd[1].tx_flags = cpu_to_le32(TX_CMD_FLG_SEQ_CTL |
667 TX_CMD_FLG_BT_DIS);
668 tx_cmd[1].rate_n_flags = iwl_mvm_scan_rate_n_flags(mvm,
669 IEEE80211_BAND_5GHZ,
670 no_cck);
671 tx_cmd[1].sta_id = mvm->aux_sta.sta_id;
672}
673
674static void
675iwl_mvm_lmac_scan_cfg_channels(struct iwl_mvm *mvm,
676 struct ieee80211_channel **channels,
677 int n_channels, u32 ssid_bitmap,
Luciano Coelho65ff5562015-03-20 13:35:47 +0200678 struct iwl_scan_req_lmac *cmd)
David Spinadelfb98be52014-05-04 12:51:10 +0300679{
680 struct iwl_scan_channel_cfg_lmac *channel_cfg = (void *)&cmd->data;
681 int i;
682
683 for (i = 0; i < n_channels; i++) {
684 channel_cfg[i].channel_num =
685 cpu_to_le16(channels[i]->hw_value);
686 channel_cfg[i].iter_count = cpu_to_le16(1);
687 channel_cfg[i].iter_interval = 0;
688 channel_cfg[i].flags =
689 cpu_to_le32(IWL_UNIFIED_SCAN_CHANNEL_PARTIAL |
690 ssid_bitmap);
691 }
692}
693
Andrei Otcheretianski66dc5272014-09-02 17:55:40 +0300694static u8 *iwl_mvm_copy_and_insert_ds_elem(struct iwl_mvm *mvm, const u8 *ies,
695 size_t len, u8 *const pos)
696{
697 static const u8 before_ds_params[] = {
698 WLAN_EID_SSID,
699 WLAN_EID_SUPP_RATES,
700 WLAN_EID_REQUEST,
701 WLAN_EID_EXT_SUPP_RATES,
702 };
703 size_t offs;
704 u8 *newpos = pos;
705
706 if (!iwl_mvm_rrm_scan_needed(mvm)) {
707 memcpy(newpos, ies, len);
708 return newpos + len;
709 }
710
711 offs = ieee80211_ie_split(ies, len,
712 before_ds_params,
713 ARRAY_SIZE(before_ds_params),
714 0);
715
716 memcpy(newpos, ies, offs);
717 newpos += offs;
718
719 /* Add a placeholder for DS Parameter Set element */
720 *newpos++ = WLAN_EID_DS_PARAMS;
721 *newpos++ = 1;
722 *newpos++ = 0;
723
724 memcpy(newpos, ies + offs, len - offs);
725 newpos += len - offs;
726
727 return newpos;
728}
729
David Spinadelfb98be52014-05-04 12:51:10 +0300730static void
Luciano Coelho65ff5562015-03-20 13:35:47 +0200731iwl_mvm_build_scan_probe(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
732 struct ieee80211_scan_ies *ies,
733 struct iwl_scan_probe_req *preq,
734 const u8 *mac_addr, const u8 *mac_addr_mask)
David Spinadelfb98be52014-05-04 12:51:10 +0300735{
David Spinadelfb98be52014-05-04 12:51:10 +0300736 struct ieee80211_mgmt *frame = (struct ieee80211_mgmt *)preq->buf;
Andrei Otcheretianski66dc5272014-09-02 17:55:40 +0300737 u8 *pos, *newpos;
David Spinadelfb98be52014-05-04 12:51:10 +0300738
Johannes Bergeffd05a2014-11-18 17:21:19 +0100739 /*
740 * Unfortunately, right now the offload scan doesn't support randomising
741 * within the firmware, so until the firmware API is ready we implement
742 * it in the driver. This means that the scan iterations won't really be
743 * random, only when it's restarted, but at least that helps a bit.
744 */
745 if (mac_addr)
746 get_random_mask_addr(frame->sa, mac_addr, mac_addr_mask);
747 else
748 memcpy(frame->sa, vif->addr, ETH_ALEN);
749
David Spinadelfb98be52014-05-04 12:51:10 +0300750 frame->frame_control = cpu_to_le16(IEEE80211_STYPE_PROBE_REQ);
751 eth_broadcast_addr(frame->da);
David Spinadelfb98be52014-05-04 12:51:10 +0300752 eth_broadcast_addr(frame->bssid);
753 frame->seq_ctrl = 0;
754
755 pos = frame->u.probe_req.variable;
756 *pos++ = WLAN_EID_SSID;
757 *pos++ = 0;
758
759 preq->mac_header.offset = 0;
760 preq->mac_header.len = cpu_to_le16(24 + 2);
761
Andrei Otcheretianski66dc5272014-09-02 17:55:40 +0300762 /* Insert ds parameter set element on 2.4 GHz band */
763 newpos = iwl_mvm_copy_and_insert_ds_elem(mvm,
764 ies->ies[IEEE80211_BAND_2GHZ],
765 ies->len[IEEE80211_BAND_2GHZ],
766 pos);
David Spinadelfb98be52014-05-04 12:51:10 +0300767 preq->band_data[0].offset = cpu_to_le16(pos - preq->buf);
Andrei Otcheretianski66dc5272014-09-02 17:55:40 +0300768 preq->band_data[0].len = cpu_to_le16(newpos - pos);
769 pos = newpos;
David Spinadelfb98be52014-05-04 12:51:10 +0300770
771 memcpy(pos, ies->ies[IEEE80211_BAND_5GHZ],
772 ies->len[IEEE80211_BAND_5GHZ]);
773 preq->band_data[1].offset = cpu_to_le16(pos - preq->buf);
774 preq->band_data[1].len = cpu_to_le16(ies->len[IEEE80211_BAND_5GHZ]);
775 pos += ies->len[IEEE80211_BAND_5GHZ];
776
777 memcpy(pos, ies->common_ies, ies->common_ie_len);
778 preq->common_data.offset = cpu_to_le16(pos - preq->buf);
779 preq->common_data.len = cpu_to_le16(ies->common_ie_len);
780}
781
782static void
Luciano Coelho65ff5562015-03-20 13:35:47 +0200783iwl_mvm_build_generic_scan_cmd(struct iwl_mvm *mvm,
784 struct iwl_scan_req_lmac *cmd,
785 struct iwl_mvm_scan_params *params)
David Spinadelfb98be52014-05-04 12:51:10 +0300786{
David Spinadelaf913442014-06-12 19:29:40 +0300787 memset(cmd, 0, ksize(cmd));
David Spinadel2ce89cd2014-07-22 13:11:18 +0300788 cmd->active_dwell = params->dwell[IEEE80211_BAND_2GHZ].active;
789 cmd->passive_dwell = params->dwell[IEEE80211_BAND_2GHZ].passive;
790 if (params->passive_fragmented)
791 cmd->fragmented_dwell =
David Spinadel190f1022015-02-17 12:45:21 +0200792 params->dwell[IEEE80211_BAND_2GHZ].fragmented;
David Spinadelfb98be52014-05-04 12:51:10 +0300793 cmd->rx_chain_select = iwl_mvm_scan_rx_chain(mvm);
794 cmd->max_out_time = cpu_to_le32(params->max_out_time);
795 cmd->suspend_time = cpu_to_le32(params->suspend_time);
796 cmd->scan_prio = cpu_to_le32(IWL_SCAN_PRIORITY_HIGH);
David Spinadelfb98be52014-05-04 12:51:10 +0300797 cmd->iter_num = cpu_to_le32(1);
David Spinadelaf913442014-06-12 19:29:40 +0300798
Andrei Otcheretianski73897bd2014-07-09 18:59:14 +0300799 if (iwl_mvm_rrm_scan_needed(mvm))
800 cmd->scan_flags |=
801 cpu_to_le32(IWL_MVM_LMAC_SCAN_FLAGS_RRM_ENABLED);
David Spinadelfb98be52014-05-04 12:51:10 +0300802}
803
Luciano Coelho999d2562015-03-27 10:28:26 +0300804static inline bool iwl_mvm_scan_fits(struct iwl_mvm *mvm, int n_ssids,
805 struct ieee80211_scan_ies *ies,
806 int n_channels)
807{
808 return ((n_ssids <= PROBE_OPTION_MAX) &&
809 (n_channels <= mvm->fw->ucode_capa.n_scan_channels) &
810 (ies->common_ie_len +
811 ies->len[NL80211_BAND_2GHZ] +
812 ies->len[NL80211_BAND_5GHZ] <=
813 iwl_mvm_max_scan_ie_fw_cmd_room(mvm)));
814}
815
Luciano Coelho6749dd82015-03-20 15:51:36 +0200816static int iwl_mvm_scan_lmac(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
817 struct cfg80211_scan_request *req,
818 struct ieee80211_scan_ies *ies)
David Spinadelfb98be52014-05-04 12:51:10 +0300819{
820 struct iwl_host_cmd hcmd = {
821 .id = SCAN_OFFLOAD_REQUEST_CMD,
Luciano Coelho83c415f2015-03-30 15:09:24 +0300822 .len = { iwl_mvm_scan_size(mvm), },
David Spinadelfb98be52014-05-04 12:51:10 +0300823 .data = { mvm->scan_cmd, },
824 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
825 };
Luciano Coelho65ff5562015-03-20 13:35:47 +0200826 struct iwl_scan_req_lmac *cmd = mvm->scan_cmd;
David Spinadeld2496222014-05-20 12:46:37 +0300827 struct iwl_scan_probe_req *preq;
David Spinadelfb98be52014-05-04 12:51:10 +0300828 struct iwl_mvm_scan_params params = {};
829 u32 flags;
Johannes Bergc8660dd2014-11-17 15:06:52 +0100830 u32 ssid_bitmap = 0;
David Spinadelfb98be52014-05-04 12:51:10 +0300831 int ret, i;
832
833 lockdep_assert_held(&mvm->mutex);
834
835 /* we should have failed registration if scan_cmd was NULL */
836 if (WARN_ON(mvm->scan_cmd == NULL))
837 return -ENOMEM;
838
Luciano Coelho999d2562015-03-27 10:28:26 +0300839 if (!iwl_mvm_scan_fits(mvm, req->n_ssids, ies, req->n_channels))
Andrei Otcheretianski48849a42014-09-09 10:58:49 +0300840 return -ENOBUFS;
David Spinadelfb98be52014-05-04 12:51:10 +0300841
Luciano Coelho9af91f42015-02-10 10:42:26 +0200842 mvm->scan_status |= IWL_MVM_SCAN_REGULAR;
David Spinadelfb98be52014-05-04 12:51:10 +0300843
Luciano Coelho6749dd82015-03-20 15:51:36 +0200844 iwl_mvm_scan_calc_params(mvm, vif, req->n_ssids, req->flags,
David Spinadelfb98be52014-05-04 12:51:10 +0300845 &params);
846
Luciano Coelho65ff5562015-03-20 13:35:47 +0200847 iwl_mvm_build_generic_scan_cmd(mvm, cmd, &params);
David Spinadelfb98be52014-05-04 12:51:10 +0300848
Luciano Coelho6749dd82015-03-20 15:51:36 +0200849 cmd->n_channels = (u8)req->n_channels;
David Spinadelfb98be52014-05-04 12:51:10 +0300850
851 flags = IWL_MVM_LMAC_SCAN_FLAG_PASS_ALL;
852
Luciano Coelho6749dd82015-03-20 15:51:36 +0200853 if (req->n_ssids == 1 && req->ssids[0].ssid_len != 0)
David Spinadelfb98be52014-05-04 12:51:10 +0300854 flags |= IWL_MVM_LMAC_SCAN_FLAG_PRE_CONNECTION;
855
856 if (params.passive_fragmented)
857 flags |= IWL_MVM_LMAC_SCAN_FLAG_FRAGMENTED;
858
Luciano Coelho6749dd82015-03-20 15:51:36 +0200859 if (req->n_ssids == 0)
David Spinadelfb98be52014-05-04 12:51:10 +0300860 flags |= IWL_MVM_LMAC_SCAN_FLAG_PASSIVE;
861
Andrei Otcheretianski73897bd2014-07-09 18:59:14 +0300862 cmd->scan_flags |= cpu_to_le32(flags);
David Spinadelfb98be52014-05-04 12:51:10 +0300863
Luciano Coelho6749dd82015-03-20 15:51:36 +0200864 cmd->flags = iwl_mvm_scan_rxon_flags(req->channels[0]->band);
David Spinadelfb98be52014-05-04 12:51:10 +0300865 cmd->filter_flags = cpu_to_le32(MAC_FILTER_ACCEPT_GRP |
866 MAC_FILTER_IN_BEACON);
Luciano Coelho6749dd82015-03-20 15:51:36 +0200867 iwl_mvm_scan_fill_tx_cmd(mvm, cmd->tx_cmd, req->no_cck);
868 iwl_mvm_scan_fill_ssids(cmd->direct_scan, req->ssids,
869 req->n_ssids, 0);
David Spinadelfb98be52014-05-04 12:51:10 +0300870
871 cmd->schedule[0].delay = 0;
872 cmd->schedule[0].iterations = 1;
873 cmd->schedule[0].full_scan_mul = 0;
874 cmd->schedule[1].delay = 0;
875 cmd->schedule[1].iterations = 0;
876 cmd->schedule[1].full_scan_mul = 0;
877
David Spinadel1f9c4182014-12-01 23:30:07 +0200878 if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_SINGLE_SCAN_EBS &&
879 mvm->last_ebs_successful) {
880 cmd->channel_opt[0].flags =
881 cpu_to_le16(IWL_SCAN_CHANNEL_FLAG_EBS |
882 IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
883 IWL_SCAN_CHANNEL_FLAG_CACHE_ADD);
884 cmd->channel_opt[0].non_ebs_ratio =
885 cpu_to_le16(IWL_DENSE_EBS_SCAN_RATIO);
886 cmd->channel_opt[1].flags =
887 cpu_to_le16(IWL_SCAN_CHANNEL_FLAG_EBS |
888 IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
889 IWL_SCAN_CHANNEL_FLAG_CACHE_ADD);
890 cmd->channel_opt[1].non_ebs_ratio =
891 cpu_to_le16(IWL_SPARSE_EBS_SCAN_RATIO);
892 }
893
Luciano Coelho6749dd82015-03-20 15:51:36 +0200894 for (i = 1; i <= req->n_ssids; i++)
David Spinadelfb98be52014-05-04 12:51:10 +0300895 ssid_bitmap |= BIT(i);
896
Luciano Coelho6749dd82015-03-20 15:51:36 +0200897 iwl_mvm_lmac_scan_cfg_channels(mvm, req->channels,
898 req->n_channels, ssid_bitmap,
David Spinadelfb98be52014-05-04 12:51:10 +0300899 cmd);
900
David Spinadeld2496222014-05-20 12:46:37 +0300901 preq = (void *)(cmd->data + sizeof(struct iwl_scan_channel_cfg_lmac) *
902 mvm->fw->ucode_capa.n_scan_channels);
903
Luciano Coelho6749dd82015-03-20 15:51:36 +0200904 iwl_mvm_build_scan_probe(mvm, vif, ies, preq,
905 req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR ?
906 req->mac_addr : NULL,
907 req->mac_addr_mask);
David Spinadelfb98be52014-05-04 12:51:10 +0300908
909 ret = iwl_mvm_send_cmd(mvm, &hcmd);
910 if (!ret) {
911 IWL_DEBUG_SCAN(mvm, "Scan request was sent successfully\n");
912 } else {
913 /*
914 * If the scan failed, it usually means that the FW was unable
915 * to allocate the time events. Warn on it, but maybe we
916 * should try to send the command again with different params.
917 */
918 IWL_ERR(mvm, "Scan failed! ret %d\n", ret);
Luciano Coelho9af91f42015-02-10 10:42:26 +0200919 mvm->scan_status &= ~IWL_MVM_SCAN_REGULAR;
David Spinadelfb98be52014-05-04 12:51:10 +0300920 ret = -EIO;
921 }
922 return ret;
923}
924
Luciano Coelho65ff5562015-03-20 13:35:47 +0200925static int iwl_mvm_sched_scan_lmac(struct iwl_mvm *mvm,
926 struct ieee80211_vif *vif,
927 struct cfg80211_sched_scan_request *req,
928 struct ieee80211_scan_ies *ies)
David Spinadelfb98be52014-05-04 12:51:10 +0300929{
930 struct iwl_host_cmd hcmd = {
931 .id = SCAN_OFFLOAD_REQUEST_CMD,
Luciano Coelho83c415f2015-03-30 15:09:24 +0300932 .len = { iwl_mvm_scan_size(mvm), },
David Spinadelfb98be52014-05-04 12:51:10 +0300933 .data = { mvm->scan_cmd, },
934 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
935 };
Luciano Coelho65ff5562015-03-20 13:35:47 +0200936 struct iwl_scan_req_lmac *cmd = mvm->scan_cmd;
David Spinadeld2496222014-05-20 12:46:37 +0300937 struct iwl_scan_probe_req *preq;
David Spinadelfb98be52014-05-04 12:51:10 +0300938 struct iwl_mvm_scan_params params = {};
939 int ret;
940 u32 flags = 0, ssid_bitmap = 0;
941
942 lockdep_assert_held(&mvm->mutex);
943
944 /* we should have failed registration if scan_cmd was NULL */
945 if (WARN_ON(mvm->scan_cmd == NULL))
946 return -ENOMEM;
947
Luciano Coelho999d2562015-03-27 10:28:26 +0300948 if (!iwl_mvm_scan_fits(mvm, req->n_ssids, ies, req->n_channels))
David Spinadelfb98be52014-05-04 12:51:10 +0300949 return -ENOBUFS;
950
951 iwl_mvm_scan_calc_params(mvm, vif, req->n_ssids, 0, &params);
952
Luciano Coelho65ff5562015-03-20 13:35:47 +0200953 iwl_mvm_build_generic_scan_cmd(mvm, cmd, &params);
David Spinadelfb98be52014-05-04 12:51:10 +0300954
955 cmd->n_channels = (u8)req->n_channels;
956
Luciano Coelho2250fd92014-12-03 10:52:26 +0200957 cmd->delay = cpu_to_le32(req->delay);
958
David Spinadeld2496222014-05-20 12:46:37 +0300959 if (iwl_mvm_scan_pass_all(mvm, req))
David Spinadelfb98be52014-05-04 12:51:10 +0300960 flags |= IWL_MVM_LMAC_SCAN_FLAG_PASS_ALL;
David Spinadel7e2a3882014-12-23 14:38:09 +0200961 else
962 flags |= IWL_MVM_LMAC_SCAN_FLAG_MATCH;
David Spinadelfb98be52014-05-04 12:51:10 +0300963
964 if (req->n_ssids == 1 && req->ssids[0].ssid_len != 0)
965 flags |= IWL_MVM_LMAC_SCAN_FLAG_PRE_CONNECTION;
966
967 if (params.passive_fragmented)
968 flags |= IWL_MVM_LMAC_SCAN_FLAG_FRAGMENTED;
969
970 if (req->n_ssids == 0)
971 flags |= IWL_MVM_LMAC_SCAN_FLAG_PASSIVE;
972
Alexander Bondare5d74642014-12-09 19:15:49 +0200973#ifdef CONFIG_IWLWIFI_DEBUGFS
974 if (mvm->scan_iter_notif_enabled)
975 flags |= IWL_MVM_LMAC_SCAN_FLAG_ITER_COMPLETE;
976#endif
977
Andrei Otcheretianski73897bd2014-07-09 18:59:14 +0300978 cmd->scan_flags |= cpu_to_le32(flags);
David Spinadelfb98be52014-05-04 12:51:10 +0300979
980 cmd->flags = iwl_mvm_scan_rxon_flags(req->channels[0]->band);
981 cmd->filter_flags = cpu_to_le32(MAC_FILTER_ACCEPT_GRP |
982 MAC_FILTER_IN_BEACON);
Luciano Coelho65ff5562015-03-20 13:35:47 +0200983 iwl_mvm_scan_fill_tx_cmd(mvm, cmd->tx_cmd, false);
David Spinadelfb98be52014-05-04 12:51:10 +0300984 iwl_scan_offload_build_ssid(req, cmd->direct_scan, &ssid_bitmap, false);
985
David Spinadelb14fc2b2014-06-25 13:17:53 +0300986 cmd->schedule[0].delay = cpu_to_le16(req->interval / MSEC_PER_SEC);
David Spinadelfb98be52014-05-04 12:51:10 +0300987 cmd->schedule[0].iterations = IWL_FAST_SCHED_SCAN_ITERATIONS;
988 cmd->schedule[0].full_scan_mul = 1;
989
David Spinadelb14fc2b2014-06-25 13:17:53 +0300990 cmd->schedule[1].delay = cpu_to_le16(req->interval / MSEC_PER_SEC);
David Spinadelfb98be52014-05-04 12:51:10 +0300991 cmd->schedule[1].iterations = 0xff;
992 cmd->schedule[1].full_scan_mul = IWL_FULL_SCAN_MULTIPLIER;
993
David Spinadel1f9c4182014-12-01 23:30:07 +0200994 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_EBS_SUPPORT &&
995 mvm->last_ebs_successful) {
996 cmd->channel_opt[0].flags =
997 cpu_to_le16(IWL_SCAN_CHANNEL_FLAG_EBS |
998 IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
999 IWL_SCAN_CHANNEL_FLAG_CACHE_ADD);
1000 cmd->channel_opt[0].non_ebs_ratio =
1001 cpu_to_le16(IWL_DENSE_EBS_SCAN_RATIO);
1002 cmd->channel_opt[1].flags =
1003 cpu_to_le16(IWL_SCAN_CHANNEL_FLAG_EBS |
1004 IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
1005 IWL_SCAN_CHANNEL_FLAG_CACHE_ADD);
1006 cmd->channel_opt[1].non_ebs_ratio =
1007 cpu_to_le16(IWL_SPARSE_EBS_SCAN_RATIO);
1008 }
1009
David Spinadelfb98be52014-05-04 12:51:10 +03001010 iwl_mvm_lmac_scan_cfg_channels(mvm, req->channels, req->n_channels,
1011 ssid_bitmap, cmd);
1012
David Spinadeld2496222014-05-20 12:46:37 +03001013 preq = (void *)(cmd->data + sizeof(struct iwl_scan_channel_cfg_lmac) *
1014 mvm->fw->ucode_capa.n_scan_channels);
1015
Luciano Coelho65ff5562015-03-20 13:35:47 +02001016 iwl_mvm_build_scan_probe(mvm, vif, ies, preq,
Johannes Bergeffd05a2014-11-18 17:21:19 +01001017 req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR ?
1018 req->mac_addr : NULL,
1019 req->mac_addr_mask);
David Spinadelfb98be52014-05-04 12:51:10 +03001020
1021 ret = iwl_mvm_send_cmd(mvm, &hcmd);
1022 if (!ret) {
1023 IWL_DEBUG_SCAN(mvm,
1024 "Sched scan request was sent successfully\n");
1025 } else {
1026 /*
1027 * If the scan failed, it usually means that the FW was unable
1028 * to allocate the time events. Warn on it, but maybe we
1029 * should try to send the command again with different params.
1030 */
1031 IWL_ERR(mvm, "Sched scan failed! ret %d\n", ret);
Luciano Coelho9af91f42015-02-10 10:42:26 +02001032 mvm->scan_status &= ~IWL_MVM_SCAN_SCHED;
David Spinadelfb98be52014-05-04 12:51:10 +03001033 ret = -EIO;
1034 }
1035 return ret;
1036}
1037
1038
1039int iwl_mvm_cancel_scan(struct iwl_mvm *mvm)
1040{
David Spinadeld2496222014-05-20 12:46:37 +03001041 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)
1042 return iwl_umac_scan_stop(mvm, IWL_UMAC_SCAN_UID_REG_SCAN,
1043 true);
1044
Luciano Coelho9af91f42015-02-10 10:42:26 +02001045 if (!(mvm->scan_status & IWL_MVM_SCAN_REGULAR))
Emmanuel Grumbach9b520d82014-11-04 15:54:11 +02001046 return 0;
1047
1048 if (iwl_mvm_is_radio_killed(mvm)) {
1049 ieee80211_scan_completed(mvm->hw, true);
1050 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
Luciano Coelho9af91f42015-02-10 10:42:26 +02001051 mvm->scan_status &= ~IWL_MVM_SCAN_REGULAR;
Emmanuel Grumbach9b520d82014-11-04 15:54:11 +02001052 return 0;
1053 }
1054
Luciano Coelho1f940382015-02-10 13:03:38 +02001055 return iwl_mvm_scan_offload_stop(mvm, true);
David Spinadelfb98be52014-05-04 12:51:10 +03001056}
David Spinadeld2496222014-05-20 12:46:37 +03001057
1058/* UMAC scan API */
1059
1060struct iwl_umac_scan_done {
1061 struct iwl_mvm *mvm;
1062 enum iwl_umac_scan_uid_type type;
1063};
1064
1065static int rate_to_scan_rate_flag(unsigned int rate)
1066{
1067 static const int rate_to_scan_rate[IWL_RATE_COUNT] = {
1068 [IWL_RATE_1M_INDEX] = SCAN_CONFIG_RATE_1M,
1069 [IWL_RATE_2M_INDEX] = SCAN_CONFIG_RATE_2M,
1070 [IWL_RATE_5M_INDEX] = SCAN_CONFIG_RATE_5M,
1071 [IWL_RATE_11M_INDEX] = SCAN_CONFIG_RATE_11M,
1072 [IWL_RATE_6M_INDEX] = SCAN_CONFIG_RATE_6M,
1073 [IWL_RATE_9M_INDEX] = SCAN_CONFIG_RATE_9M,
1074 [IWL_RATE_12M_INDEX] = SCAN_CONFIG_RATE_12M,
1075 [IWL_RATE_18M_INDEX] = SCAN_CONFIG_RATE_18M,
1076 [IWL_RATE_24M_INDEX] = SCAN_CONFIG_RATE_24M,
1077 [IWL_RATE_36M_INDEX] = SCAN_CONFIG_RATE_36M,
1078 [IWL_RATE_48M_INDEX] = SCAN_CONFIG_RATE_48M,
1079 [IWL_RATE_54M_INDEX] = SCAN_CONFIG_RATE_54M,
1080 };
1081
1082 return rate_to_scan_rate[rate];
1083}
1084
1085static __le32 iwl_mvm_scan_config_rates(struct iwl_mvm *mvm)
1086{
1087 struct ieee80211_supported_band *band;
1088 unsigned int rates = 0;
1089 int i;
1090
1091 band = &mvm->nvm_data->bands[IEEE80211_BAND_2GHZ];
1092 for (i = 0; i < band->n_bitrates; i++)
1093 rates |= rate_to_scan_rate_flag(band->bitrates[i].hw_value);
1094 band = &mvm->nvm_data->bands[IEEE80211_BAND_5GHZ];
1095 for (i = 0; i < band->n_bitrates; i++)
1096 rates |= rate_to_scan_rate_flag(band->bitrates[i].hw_value);
1097
1098 /* Set both basic rates and supported rates */
1099 rates |= SCAN_CONFIG_SUPPORTED_RATE(rates);
1100
1101 return cpu_to_le32(rates);
1102}
1103
1104int iwl_mvm_config_scan(struct iwl_mvm *mvm)
1105{
1106
1107 struct iwl_scan_config *scan_config;
1108 struct ieee80211_supported_band *band;
1109 int num_channels =
1110 mvm->nvm_data->bands[IEEE80211_BAND_2GHZ].n_channels +
1111 mvm->nvm_data->bands[IEEE80211_BAND_5GHZ].n_channels;
1112 int ret, i, j = 0, cmd_size, data_size;
1113 struct iwl_host_cmd cmd = {
1114 .id = SCAN_CFG_CMD,
1115 };
1116
1117 if (WARN_ON(num_channels > mvm->fw->ucode_capa.n_scan_channels))
1118 return -ENOBUFS;
1119
1120 cmd_size = sizeof(*scan_config) + mvm->fw->ucode_capa.n_scan_channels;
1121
1122 scan_config = kzalloc(cmd_size, GFP_KERNEL);
1123 if (!scan_config)
1124 return -ENOMEM;
1125
1126 data_size = cmd_size - sizeof(struct iwl_mvm_umac_cmd_hdr);
1127 scan_config->hdr.size = cpu_to_le16(data_size);
1128 scan_config->flags = cpu_to_le32(SCAN_CONFIG_FLAG_ACTIVATE |
1129 SCAN_CONFIG_FLAG_ALLOW_CHUB_REQS |
1130 SCAN_CONFIG_FLAG_SET_TX_CHAINS |
1131 SCAN_CONFIG_FLAG_SET_RX_CHAINS |
1132 SCAN_CONFIG_FLAG_SET_ALL_TIMES |
1133 SCAN_CONFIG_FLAG_SET_LEGACY_RATES |
1134 SCAN_CONFIG_FLAG_SET_MAC_ADDR |
1135 SCAN_CONFIG_FLAG_SET_CHANNEL_FLAGS|
1136 SCAN_CONFIG_N_CHANNELS(num_channels));
Moshe Harela0544272014-12-08 21:13:14 +02001137 scan_config->tx_chains = cpu_to_le32(iwl_mvm_get_valid_tx_ant(mvm));
David Spinadeld2496222014-05-20 12:46:37 +03001138 scan_config->rx_chains = cpu_to_le32(iwl_mvm_scan_rx_ant(mvm));
1139 scan_config->legacy_rates = iwl_mvm_scan_config_rates(mvm);
1140 scan_config->out_of_channel_time = cpu_to_le32(170);
1141 scan_config->suspend_time = cpu_to_le32(30);
1142 scan_config->dwell_active = 20;
1143 scan_config->dwell_passive = 110;
1144 scan_config->dwell_fragmented = 20;
1145
1146 memcpy(&scan_config->mac_addr, &mvm->addresses[0].addr, ETH_ALEN);
1147
1148 scan_config->bcast_sta_id = mvm->aux_sta.sta_id;
1149 scan_config->channel_flags = IWL_CHANNEL_FLAG_EBS |
1150 IWL_CHANNEL_FLAG_ACCURATE_EBS |
1151 IWL_CHANNEL_FLAG_EBS_ADD |
1152 IWL_CHANNEL_FLAG_PRE_SCAN_PASSIVE2ACTIVE;
1153
1154 band = &mvm->nvm_data->bands[IEEE80211_BAND_2GHZ];
1155 for (i = 0; i < band->n_channels; i++, j++)
Ilan Peera25d40e2015-01-23 21:13:01 +02001156 scan_config->channel_array[j] = band->channels[i].hw_value;
David Spinadeld2496222014-05-20 12:46:37 +03001157 band = &mvm->nvm_data->bands[IEEE80211_BAND_5GHZ];
1158 for (i = 0; i < band->n_channels; i++, j++)
Ilan Peera25d40e2015-01-23 21:13:01 +02001159 scan_config->channel_array[j] = band->channels[i].hw_value;
David Spinadeld2496222014-05-20 12:46:37 +03001160
1161 cmd.data[0] = scan_config;
1162 cmd.len[0] = cmd_size;
1163 cmd.dataflags[0] = IWL_HCMD_DFL_NOCOPY;
1164
1165 IWL_DEBUG_SCAN(mvm, "Sending UMAC scan config\n");
1166
1167 ret = iwl_mvm_send_cmd(mvm, &cmd);
1168
1169 kfree(scan_config);
1170 return ret;
1171}
1172
1173static int iwl_mvm_find_scan_uid(struct iwl_mvm *mvm, u32 uid)
1174{
1175 int i;
1176
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001177 for (i = 0; i < mvm->max_scans; i++)
David Spinadeld2496222014-05-20 12:46:37 +03001178 if (mvm->scan_uid[i] == uid)
1179 return i;
1180
1181 return i;
1182}
1183
1184static int iwl_mvm_find_free_scan_uid(struct iwl_mvm *mvm)
1185{
1186 return iwl_mvm_find_scan_uid(mvm, 0);
1187}
1188
1189static bool iwl_mvm_find_scan_type(struct iwl_mvm *mvm,
1190 enum iwl_umac_scan_uid_type type)
1191{
1192 int i;
1193
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001194 for (i = 0; i < mvm->max_scans; i++)
David Spinadeld2496222014-05-20 12:46:37 +03001195 if (mvm->scan_uid[i] & type)
1196 return true;
1197
1198 return false;
1199}
1200
Alexander Bondar963221b2015-03-26 11:07:35 +02001201static int iwl_mvm_find_first_scan(struct iwl_mvm *mvm,
1202 enum iwl_umac_scan_uid_type type)
1203{
1204 int i;
1205
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001206 for (i = 0; i < mvm->max_scans; i++)
Alexander Bondar963221b2015-03-26 11:07:35 +02001207 if (mvm->scan_uid[i] & type)
1208 return i;
1209
1210 return i;
1211}
1212
David Spinadeld2496222014-05-20 12:46:37 +03001213static u32 iwl_generate_scan_uid(struct iwl_mvm *mvm,
1214 enum iwl_umac_scan_uid_type type)
1215{
1216 u32 uid;
1217
1218 /* make sure exactly one bit is on in scan type */
1219 WARN_ON(hweight8(type) != 1);
1220
1221 /*
1222 * Make sure scan uids are unique. If one scan lasts long time while
1223 * others are completing frequently, the seq number will wrap up and
1224 * we may have more than one scan with the same uid.
1225 */
1226 do {
1227 uid = type | (mvm->scan_seq_num <<
1228 IWL_UMAC_SCAN_UID_SEQ_OFFSET);
1229 mvm->scan_seq_num++;
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001230 } while (iwl_mvm_find_scan_uid(mvm, uid) < mvm->max_scans);
David Spinadeld2496222014-05-20 12:46:37 +03001231
1232 IWL_DEBUG_SCAN(mvm, "Generated scan UID %u\n", uid);
1233
1234 return uid;
1235}
1236
1237static void
1238iwl_mvm_build_generic_umac_scan_cmd(struct iwl_mvm *mvm,
1239 struct iwl_scan_req_umac *cmd,
1240 struct iwl_mvm_scan_params *params)
1241{
1242 memset(cmd, 0, ksize(cmd));
1243 cmd->hdr.size = cpu_to_le16(iwl_mvm_scan_size(mvm) -
1244 sizeof(struct iwl_mvm_umac_cmd_hdr));
1245 cmd->active_dwell = params->dwell[IEEE80211_BAND_2GHZ].active;
1246 cmd->passive_dwell = params->dwell[IEEE80211_BAND_2GHZ].passive;
1247 if (params->passive_fragmented)
1248 cmd->fragmented_dwell =
David Spinadel190f1022015-02-17 12:45:21 +02001249 params->dwell[IEEE80211_BAND_2GHZ].fragmented;
David Spinadeld2496222014-05-20 12:46:37 +03001250 cmd->max_out_time = cpu_to_le32(params->max_out_time);
1251 cmd->suspend_time = cpu_to_le32(params->suspend_time);
1252 cmd->scan_priority = cpu_to_le32(IWL_SCAN_PRIORITY_HIGH);
1253}
1254
1255static void
1256iwl_mvm_umac_scan_cfg_channels(struct iwl_mvm *mvm,
1257 struct ieee80211_channel **channels,
1258 int n_channels, u32 ssid_bitmap,
1259 struct iwl_scan_req_umac *cmd)
1260{
1261 struct iwl_scan_channel_cfg_umac *channel_cfg = (void *)&cmd->data;
1262 int i;
1263
1264 for (i = 0; i < n_channels; i++) {
1265 channel_cfg[i].flags = cpu_to_le32(ssid_bitmap);
1266 channel_cfg[i].channel_num = channels[i]->hw_value;
1267 channel_cfg[i].iter_count = 1;
1268 channel_cfg[i].iter_interval = 0;
1269 }
1270}
1271
1272static u32 iwl_mvm_scan_umac_common_flags(struct iwl_mvm *mvm, int n_ssids,
1273 struct cfg80211_ssid *ssids,
1274 int fragmented)
1275{
1276 int flags = 0;
1277
1278 if (n_ssids == 0)
1279 flags = IWL_UMAC_SCAN_GEN_FLAGS_PASSIVE;
1280
1281 if (n_ssids == 1 && ssids[0].ssid_len != 0)
1282 flags |= IWL_UMAC_SCAN_GEN_FLAGS_PRE_CONNECT;
1283
1284 if (fragmented)
1285 flags |= IWL_UMAC_SCAN_GEN_FLAGS_FRAGMENTED;
1286
1287 if (iwl_mvm_rrm_scan_needed(mvm))
1288 flags |= IWL_UMAC_SCAN_GEN_FLAGS_RRM_ENABLED;
1289
1290 return flags;
1291}
1292
Luciano Coelho6749dd82015-03-20 15:51:36 +02001293static int iwl_mvm_scan_umac(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
1294 struct cfg80211_scan_request *req,
1295 struct ieee80211_scan_ies *ies)
David Spinadeld2496222014-05-20 12:46:37 +03001296{
1297 struct iwl_host_cmd hcmd = {
1298 .id = SCAN_REQ_UMAC,
1299 .len = { iwl_mvm_scan_size(mvm), },
1300 .data = { mvm->scan_cmd, },
1301 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
1302 };
1303 struct iwl_scan_req_umac *cmd = mvm->scan_cmd;
1304 struct iwl_scan_req_umac_tail *sec_part = (void *)&cmd->data +
1305 sizeof(struct iwl_scan_channel_cfg_umac) *
1306 mvm->fw->ucode_capa.n_scan_channels;
1307 struct iwl_mvm_scan_params params = {};
1308 u32 uid, flags;
Johannes Bergc8660dd2014-11-17 15:06:52 +01001309 u32 ssid_bitmap = 0;
David Spinadeld2496222014-05-20 12:46:37 +03001310 int ret, i, uid_idx;
1311
1312 lockdep_assert_held(&mvm->mutex);
1313
1314 uid_idx = iwl_mvm_find_free_scan_uid(mvm);
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001315 if (uid_idx >= mvm->max_scans)
David Spinadeld2496222014-05-20 12:46:37 +03001316 return -EBUSY;
1317
1318 /* we should have failed registration if scan_cmd was NULL */
1319 if (WARN_ON(mvm->scan_cmd == NULL))
1320 return -ENOMEM;
1321
Luciano Coelho999d2562015-03-27 10:28:26 +03001322 if (!iwl_mvm_scan_fits(mvm, req->n_ssids, ies, req->n_channels))
David Spinadeld2496222014-05-20 12:46:37 +03001323 return -ENOBUFS;
1324
Luciano Coelho6749dd82015-03-20 15:51:36 +02001325 iwl_mvm_scan_calc_params(mvm, vif, req->n_ssids, req->flags,
David Spinadeld2496222014-05-20 12:46:37 +03001326 &params);
1327
1328 iwl_mvm_build_generic_umac_scan_cmd(mvm, cmd, &params);
1329
1330 uid = iwl_generate_scan_uid(mvm, IWL_UMAC_SCAN_UID_REG_SCAN);
1331 mvm->scan_uid[uid_idx] = uid;
1332 cmd->uid = cpu_to_le32(uid);
1333
1334 cmd->ooc_priority = cpu_to_le32(IWL_SCAN_PRIORITY_HIGH);
1335
Luciano Coelho6749dd82015-03-20 15:51:36 +02001336 flags = iwl_mvm_scan_umac_common_flags(mvm, req->n_ssids,
1337 req->ssids,
David Spinadeld2496222014-05-20 12:46:37 +03001338 params.passive_fragmented);
1339
1340 flags |= IWL_UMAC_SCAN_GEN_FLAGS_PASS_ALL;
1341
1342 cmd->general_flags = cpu_to_le32(flags);
Haim Dreyfuss4db65582015-01-05 15:00:35 +02001343
1344 if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_SINGLE_SCAN_EBS &&
1345 mvm->last_ebs_successful)
1346 cmd->channel_flags = IWL_SCAN_CHANNEL_FLAG_EBS |
1347 IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
1348 IWL_SCAN_CHANNEL_FLAG_CACHE_ADD;
1349
Luciano Coelho6749dd82015-03-20 15:51:36 +02001350 cmd->n_channels = req->n_channels;
David Spinadeld2496222014-05-20 12:46:37 +03001351
Luciano Coelho6749dd82015-03-20 15:51:36 +02001352 for (i = 0; i < req->n_ssids; i++)
David Spinadeld2496222014-05-20 12:46:37 +03001353 ssid_bitmap |= BIT(i);
1354
Luciano Coelho6749dd82015-03-20 15:51:36 +02001355 iwl_mvm_umac_scan_cfg_channels(mvm, req->channels,
1356 req->n_channels, ssid_bitmap, cmd);
David Spinadeld2496222014-05-20 12:46:37 +03001357
1358 sec_part->schedule[0].iter_count = 1;
1359 sec_part->delay = 0;
1360
Luciano Coelho6749dd82015-03-20 15:51:36 +02001361 iwl_mvm_build_scan_probe(mvm, vif, ies, &sec_part->preq,
1362 req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR ?
1363 req->mac_addr : NULL,
1364 req->mac_addr_mask);
David Spinadeld2496222014-05-20 12:46:37 +03001365
Luciano Coelho6749dd82015-03-20 15:51:36 +02001366 iwl_mvm_scan_fill_ssids(sec_part->direct_scan, req->ssids,
1367 req->n_ssids, 0);
David Spinadeld2496222014-05-20 12:46:37 +03001368
1369 ret = iwl_mvm_send_cmd(mvm, &hcmd);
1370 if (!ret) {
1371 IWL_DEBUG_SCAN(mvm,
1372 "Scan request was sent successfully\n");
1373 } else {
1374 /*
1375 * If the scan failed, it usually means that the FW was unable
1376 * to allocate the time events. Warn on it, but maybe we
1377 * should try to send the command again with different params.
1378 */
1379 IWL_ERR(mvm, "Scan failed! ret %d\n", ret);
1380 }
1381 return ret;
1382}
1383
Luciano Coelho6749dd82015-03-20 15:51:36 +02001384static int iwl_mvm_sched_scan_umac(struct iwl_mvm *mvm,
1385 struct ieee80211_vif *vif,
1386 struct cfg80211_sched_scan_request *req,
1387 struct ieee80211_scan_ies *ies)
David Spinadeld2496222014-05-20 12:46:37 +03001388{
1389
1390 struct iwl_host_cmd hcmd = {
1391 .id = SCAN_REQ_UMAC,
1392 .len = { iwl_mvm_scan_size(mvm), },
1393 .data = { mvm->scan_cmd, },
1394 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
1395 };
1396 struct iwl_scan_req_umac *cmd = mvm->scan_cmd;
1397 struct iwl_scan_req_umac_tail *sec_part = (void *)&cmd->data +
1398 sizeof(struct iwl_scan_channel_cfg_umac) *
1399 mvm->fw->ucode_capa.n_scan_channels;
1400 struct iwl_mvm_scan_params params = {};
1401 u32 uid, flags;
Johannes Bergc8660dd2014-11-17 15:06:52 +01001402 u32 ssid_bitmap = 0;
David Spinadeld2496222014-05-20 12:46:37 +03001403 int ret, uid_idx;
1404
1405 lockdep_assert_held(&mvm->mutex);
1406
1407 uid_idx = iwl_mvm_find_free_scan_uid(mvm);
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001408 if (uid_idx >= mvm->max_scans)
David Spinadeld2496222014-05-20 12:46:37 +03001409 return -EBUSY;
1410
1411 /* we should have failed registration if scan_cmd was NULL */
1412 if (WARN_ON(mvm->scan_cmd == NULL))
1413 return -ENOMEM;
1414
Luciano Coelho999d2562015-03-27 10:28:26 +03001415 if (!iwl_mvm_scan_fits(mvm, req->n_ssids, ies, req->n_channels))
David Spinadeld2496222014-05-20 12:46:37 +03001416 return -ENOBUFS;
1417
1418 iwl_mvm_scan_calc_params(mvm, vif, req->n_ssids, req->flags,
1419 &params);
1420
1421 iwl_mvm_build_generic_umac_scan_cmd(mvm, cmd, &params);
1422
1423 cmd->flags = cpu_to_le32(IWL_UMAC_SCAN_FLAG_PREEMPTIVE);
1424
1425 uid = iwl_generate_scan_uid(mvm, IWL_UMAC_SCAN_UID_SCHED_SCAN);
1426 mvm->scan_uid[uid_idx] = uid;
1427 cmd->uid = cpu_to_le32(uid);
1428
1429 cmd->ooc_priority = cpu_to_le32(IWL_SCAN_PRIORITY_LOW);
1430
1431 flags = iwl_mvm_scan_umac_common_flags(mvm, req->n_ssids, req->ssids,
1432 params.passive_fragmented);
1433
1434 flags |= IWL_UMAC_SCAN_GEN_FLAGS_PERIODIC;
1435
1436 if (iwl_mvm_scan_pass_all(mvm, req))
1437 flags |= IWL_UMAC_SCAN_GEN_FLAGS_PASS_ALL;
1438 else
1439 flags |= IWL_UMAC_SCAN_GEN_FLAGS_MATCH;
1440
1441 cmd->general_flags = cpu_to_le32(flags);
1442
1443 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_EBS_SUPPORT &&
1444 mvm->last_ebs_successful)
1445 cmd->channel_flags = IWL_SCAN_CHANNEL_FLAG_EBS |
1446 IWL_SCAN_CHANNEL_FLAG_EBS_ACCURATE |
1447 IWL_SCAN_CHANNEL_FLAG_CACHE_ADD;
1448
1449 cmd->n_channels = req->n_channels;
1450
1451 iwl_scan_offload_build_ssid(req, sec_part->direct_scan, &ssid_bitmap,
1452 false);
1453
1454 /* This API uses bits 0-19 instead of 1-20. */
1455 ssid_bitmap = ssid_bitmap >> 1;
1456
1457 iwl_mvm_umac_scan_cfg_channels(mvm, req->channels, req->n_channels,
1458 ssid_bitmap, cmd);
1459
1460 sec_part->schedule[0].interval =
1461 cpu_to_le16(req->interval / MSEC_PER_SEC);
1462 sec_part->schedule[0].iter_count = 0xff;
1463
Luciano Coelho2250fd92014-12-03 10:52:26 +02001464 if (req->delay > U16_MAX) {
1465 IWL_DEBUG_SCAN(mvm,
1466 "delay value is > 16-bits, set to max possible\n");
1467 sec_part->delay = cpu_to_le16(U16_MAX);
1468 } else {
1469 sec_part->delay = cpu_to_le16(req->delay);
1470 }
David Spinadeld2496222014-05-20 12:46:37 +03001471
Luciano Coelho65ff5562015-03-20 13:35:47 +02001472 iwl_mvm_build_scan_probe(mvm, vif, ies, &sec_part->preq,
Johannes Bergeffd05a2014-11-18 17:21:19 +01001473 req->flags & NL80211_SCAN_FLAG_RANDOM_ADDR ?
1474 req->mac_addr : NULL,
1475 req->mac_addr_mask);
David Spinadeld2496222014-05-20 12:46:37 +03001476
1477 ret = iwl_mvm_send_cmd(mvm, &hcmd);
1478 if (!ret) {
1479 IWL_DEBUG_SCAN(mvm,
1480 "Sched scan request was sent successfully\n");
1481 } else {
1482 /*
1483 * If the scan failed, it usually means that the FW was unable
1484 * to allocate the time events. Warn on it, but maybe we
1485 * should try to send the command again with different params.
1486 */
1487 IWL_ERR(mvm, "Sched scan failed! ret %d\n", ret);
1488 }
1489 return ret;
1490}
1491
Luciano Coelho6749dd82015-03-20 15:51:36 +02001492static int iwl_mvm_num_scans(struct iwl_mvm *mvm)
1493{
1494 return hweight32(mvm->scan_status & IWL_MVM_SCAN_MASK);
1495}
1496
1497static int iwl_mvm_check_running_scans(struct iwl_mvm *mvm, int type)
1498{
1499 /* This looks a bit arbitrary, but the idea is that if we run
1500 * out of possible simultaneous scans and the userspace is
1501 * trying to run a scan type that is already running, we
1502 * return -EBUSY. But if the userspace wants to start a
1503 * different type of scan, we stop the opposite type to make
1504 * space for the new request. The reason is backwards
1505 * compatibility with old wpa_supplicant that wouldn't stop a
1506 * scheduled scan before starting a normal scan.
1507 */
1508
1509 if (iwl_mvm_num_scans(mvm) < mvm->max_scans)
1510 return 0;
1511
1512 /* Use a switch, even though this is a bitmask, so that more
1513 * than one bits set will fall in default and we will warn.
1514 */
1515 switch (type) {
1516 case IWL_MVM_SCAN_REGULAR:
1517 if (mvm->scan_status & IWL_MVM_SCAN_REGULAR_MASK)
1518 return -EBUSY;
1519 return iwl_mvm_scan_offload_stop(mvm, true);
1520 case IWL_MVM_SCAN_SCHED:
1521 if (mvm->scan_status & IWL_MVM_SCAN_SCHED_MASK)
1522 return -EBUSY;
1523 return iwl_mvm_cancel_scan(mvm);
Luciano Coelho19945df2015-03-20 16:11:28 +02001524 case IWL_MVM_SCAN_NETDETECT:
1525 /* No need to stop anything for net-detect since the
1526 * firmware is restarted anyway. This way, any sched
1527 * scans that were running will be restarted when we
1528 * resume.
1529 */
1530 return 0;
Luciano Coelho6749dd82015-03-20 15:51:36 +02001531 default:
1532 WARN_ON(1);
1533 break;
1534 }
1535
1536 return -EIO;
1537}
1538
1539int iwl_mvm_reg_scan_start(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
1540 struct cfg80211_scan_request *req,
1541 struct ieee80211_scan_ies *ies)
1542{
1543 int ret;
1544
1545 lockdep_assert_held(&mvm->mutex);
1546
1547 if (iwl_mvm_is_lar_supported(mvm) && !mvm->lar_regdom_set) {
1548 IWL_ERR(mvm, "scan while LAR regdomain is not set\n");
1549 return -EBUSY;
1550 }
1551
1552 ret = iwl_mvm_check_running_scans(mvm, IWL_MVM_SCAN_REGULAR);
1553 if (ret)
1554 return ret;
1555
1556 iwl_mvm_ref(mvm, IWL_MVM_REF_SCAN);
1557
1558 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)
1559 ret = iwl_mvm_scan_umac(mvm, vif, req, ies);
1560 else
1561 ret = iwl_mvm_scan_lmac(mvm, vif, req, ies);
1562
1563 if (ret)
1564 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
1565
1566 return ret;
1567}
1568
Luciano Coelho65ff5562015-03-20 13:35:47 +02001569int iwl_mvm_sched_scan_start(struct iwl_mvm *mvm,
1570 struct ieee80211_vif *vif,
1571 struct cfg80211_sched_scan_request *req,
Luciano Coelho19945df2015-03-20 16:11:28 +02001572 struct ieee80211_scan_ies *ies,
1573 int type)
Luciano Coelho65ff5562015-03-20 13:35:47 +02001574{
1575 int ret;
1576
Luciano Coelho6749dd82015-03-20 15:51:36 +02001577 lockdep_assert_held(&mvm->mutex);
1578
1579 if (iwl_mvm_is_lar_supported(mvm) && !mvm->lar_regdom_set) {
1580 IWL_ERR(mvm, "sched-scan while LAR regdomain is not set\n");
1581 return -EBUSY;
1582 }
1583
Luciano Coelho19945df2015-03-20 16:11:28 +02001584 ret = iwl_mvm_check_running_scans(mvm, type);
Luciano Coelho6749dd82015-03-20 15:51:36 +02001585 if (ret)
1586 return ret;
1587
Luciano Coelho65ff5562015-03-20 13:35:47 +02001588 ret = iwl_mvm_config_sched_scan_profiles(mvm, req);
1589 if (ret)
1590 return ret;
1591
1592 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN) {
1593 ret = iwl_mvm_sched_scan_umac(mvm, vif, req, ies);
1594 } else {
1595 ret = iwl_mvm_sched_scan_lmac(mvm, vif, req, ies);
1596 if (!ret)
1597 mvm->scan_status |= IWL_MVM_SCAN_SCHED;
1598 }
1599
1600 return ret;
1601}
1602
David Spinadeld2496222014-05-20 12:46:37 +03001603int iwl_mvm_rx_umac_scan_complete_notif(struct iwl_mvm *mvm,
1604 struct iwl_rx_cmd_buffer *rxb,
1605 struct iwl_device_cmd *cmd)
1606{
1607 struct iwl_rx_packet *pkt = rxb_addr(rxb);
1608 struct iwl_umac_scan_complete *notif = (void *)pkt->data;
1609 u32 uid = __le32_to_cpu(notif->uid);
1610 bool sched = !!(uid & IWL_UMAC_SCAN_UID_SCHED_SCAN);
1611 int uid_idx = iwl_mvm_find_scan_uid(mvm, uid);
1612
David Spinadel2992a322014-11-10 11:16:53 +02001613 /*
1614 * Scan uid may be set to zero in case of scan abort request from above.
1615 */
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001616 if (uid_idx >= mvm->max_scans)
David Spinadeld2496222014-05-20 12:46:37 +03001617 return 0;
1618
1619 IWL_DEBUG_SCAN(mvm,
1620 "Scan completed, uid %u type %s, status %s, EBS status %s\n",
1621 uid, sched ? "sched" : "regular",
1622 notif->status == IWL_SCAN_OFFLOAD_COMPLETED ?
1623 "completed" : "aborted",
1624 notif->ebs_status == IWL_SCAN_EBS_SUCCESS ?
1625 "success" : "failed");
1626
Haim Dreyfuss5a4b2af2015-01-13 11:54:51 +02001627 if (notif->ebs_status)
1628 mvm->last_ebs_successful = false;
1629
David Spinadeld2496222014-05-20 12:46:37 +03001630 mvm->scan_uid[uid_idx] = 0;
1631
1632 if (!sched) {
1633 ieee80211_scan_completed(mvm->hw,
1634 notif->status ==
1635 IWL_SCAN_OFFLOAD_ABORTED);
1636 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
1637 } else if (!iwl_mvm_find_scan_type(mvm, IWL_UMAC_SCAN_UID_SCHED_SCAN)) {
1638 ieee80211_sched_scan_stopped(mvm->hw);
1639 } else {
1640 IWL_DEBUG_SCAN(mvm, "Another sched scan is running\n");
1641 }
1642
1643 return 0;
1644}
1645
1646static bool iwl_scan_umac_done_check(struct iwl_notif_wait_data *notif_wait,
1647 struct iwl_rx_packet *pkt, void *data)
1648{
1649 struct iwl_umac_scan_done *scan_done = data;
1650 struct iwl_umac_scan_complete *notif = (void *)pkt->data;
1651 u32 uid = __le32_to_cpu(notif->uid);
1652 int uid_idx = iwl_mvm_find_scan_uid(scan_done->mvm, uid);
1653
1654 if (WARN_ON(pkt->hdr.cmd != SCAN_COMPLETE_UMAC))
1655 return false;
1656
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001657 if (uid_idx >= scan_done->mvm->max_scans)
David Spinadeld2496222014-05-20 12:46:37 +03001658 return false;
1659
1660 /*
1661 * Clear scan uid of scans that was aborted from above and completed
Haim Dreyfuss5a4b2af2015-01-13 11:54:51 +02001662 * in FW so the RX handler does nothing. Set last_ebs_successful here if
1663 * needed.
David Spinadeld2496222014-05-20 12:46:37 +03001664 */
1665 scan_done->mvm->scan_uid[uid_idx] = 0;
1666
Haim Dreyfuss5a4b2af2015-01-13 11:54:51 +02001667 if (notif->ebs_status)
1668 scan_done->mvm->last_ebs_successful = false;
1669
David Spinadeld2496222014-05-20 12:46:37 +03001670 return !iwl_mvm_find_scan_type(scan_done->mvm, scan_done->type);
1671}
1672
1673static int iwl_umac_scan_abort_one(struct iwl_mvm *mvm, u32 uid)
1674{
1675 struct iwl_umac_scan_abort cmd = {
1676 .hdr.size = cpu_to_le16(sizeof(struct iwl_umac_scan_abort) -
1677 sizeof(struct iwl_mvm_umac_cmd_hdr)),
1678 .uid = cpu_to_le32(uid),
1679 };
1680
1681 lockdep_assert_held(&mvm->mutex);
1682
1683 IWL_DEBUG_SCAN(mvm, "Sending scan abort, uid %u\n", uid);
1684
1685 return iwl_mvm_send_cmd_pdu(mvm, SCAN_ABORT_UMAC, 0, sizeof(cmd), &cmd);
1686}
1687
1688static int iwl_umac_scan_stop(struct iwl_mvm *mvm,
1689 enum iwl_umac_scan_uid_type type, bool notify)
1690{
1691 struct iwl_notification_wait wait_scan_done;
1692 static const u8 scan_done_notif[] = { SCAN_COMPLETE_UMAC, };
1693 struct iwl_umac_scan_done scan_done = {
1694 .mvm = mvm,
1695 .type = type,
1696 };
1697 int i, ret = -EIO;
1698
1699 iwl_init_notification_wait(&mvm->notif_wait, &wait_scan_done,
1700 scan_done_notif,
1701 ARRAY_SIZE(scan_done_notif),
1702 iwl_scan_umac_done_check, &scan_done);
1703
1704 IWL_DEBUG_SCAN(mvm, "Preparing to stop scan, type %x\n", type);
1705
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001706 for (i = 0; i < mvm->max_scans; i++) {
David Spinadeld2496222014-05-20 12:46:37 +03001707 if (mvm->scan_uid[i] & type) {
1708 int err;
1709
1710 if (iwl_mvm_is_radio_killed(mvm) &&
1711 (type & IWL_UMAC_SCAN_UID_REG_SCAN)) {
1712 ieee80211_scan_completed(mvm->hw, true);
1713 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
1714 break;
1715 }
1716
1717 err = iwl_umac_scan_abort_one(mvm, mvm->scan_uid[i]);
1718 if (!err)
1719 ret = 0;
1720 }
1721 }
1722
1723 if (ret) {
1724 IWL_DEBUG_SCAN(mvm, "Couldn't stop scan\n");
1725 iwl_remove_notification(&mvm->notif_wait, &wait_scan_done);
1726 return ret;
1727 }
1728
1729 ret = iwl_wait_notification(&mvm->notif_wait, &wait_scan_done, 1 * HZ);
1730 if (ret)
1731 return ret;
1732
1733 if (notify) {
1734 if (type & IWL_UMAC_SCAN_UID_SCHED_SCAN)
1735 ieee80211_sched_scan_stopped(mvm->hw);
1736 if (type & IWL_UMAC_SCAN_UID_REG_SCAN) {
1737 ieee80211_scan_completed(mvm->hw, true);
1738 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
1739 }
1740 }
1741
1742 return ret;
1743}
1744
1745int iwl_mvm_scan_size(struct iwl_mvm *mvm)
1746{
1747 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)
1748 return sizeof(struct iwl_scan_req_umac) +
1749 sizeof(struct iwl_scan_channel_cfg_umac) *
1750 mvm->fw->ucode_capa.n_scan_channels +
1751 sizeof(struct iwl_scan_req_umac_tail);
1752
Luciano Coelho65ff5562015-03-20 13:35:47 +02001753 return sizeof(struct iwl_scan_req_lmac) +
Luciano Coelho1f940382015-02-10 13:03:38 +02001754 sizeof(struct iwl_scan_channel_cfg_lmac) *
1755 mvm->fw->ucode_capa.n_scan_channels +
1756 sizeof(struct iwl_scan_probe_req);
David Spinadeld2496222014-05-20 12:46:37 +03001757}
David Spinadel4ffb3652015-03-10 10:06:02 +02001758
1759/*
1760 * This function is used in nic restart flow, to inform mac80211 about scans
1761 * that was aborted by restart flow or by an assert.
1762 */
1763void iwl_mvm_report_scan_aborted(struct iwl_mvm *mvm)
1764{
1765 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN) {
Alexander Bondar963221b2015-03-26 11:07:35 +02001766 u32 uid, i;
1767
1768 uid = iwl_mvm_find_first_scan(mvm, IWL_UMAC_SCAN_UID_REG_SCAN);
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001769 if (uid < mvm->max_scans) {
David Spinadel4ffb3652015-03-10 10:06:02 +02001770 ieee80211_scan_completed(mvm->hw, true);
Alexander Bondar963221b2015-03-26 11:07:35 +02001771 mvm->scan_uid[uid] = 0;
1772 }
1773 uid = iwl_mvm_find_first_scan(mvm,
1774 IWL_UMAC_SCAN_UID_SCHED_SCAN);
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001775 if (uid < mvm->max_scans && !mvm->restart_fw) {
David Spinadel4ffb3652015-03-10 10:06:02 +02001776 ieee80211_sched_scan_stopped(mvm->hw);
Alexander Bondar963221b2015-03-26 11:07:35 +02001777 mvm->scan_uid[uid] = 0;
1778 }
1779
1780 /* We shouldn't have any UIDs still set. Loop over all the
1781 * UIDs to make sure there's nothing left there and warn if
1782 * any is found.
1783 */
Luciano Coelho507e4cd2015-03-19 22:58:33 +02001784 for (i = 0; i < mvm->max_scans; i++) {
Alexander Bondar963221b2015-03-26 11:07:35 +02001785 if (WARN_ONCE(mvm->scan_uid[i],
1786 "UMAC scan UID %d was not cleaned\n",
1787 mvm->scan_uid[i]))
1788 mvm->scan_uid[i] = 0;
1789 }
David Spinadel4ffb3652015-03-10 10:06:02 +02001790 } else {
Luciano Coelho9af91f42015-02-10 10:42:26 +02001791 if (mvm->scan_status & IWL_MVM_SCAN_REGULAR)
David Spinadel4ffb3652015-03-10 10:06:02 +02001792 ieee80211_scan_completed(mvm->hw, true);
Luciano Coelho9af91f42015-02-10 10:42:26 +02001793
1794 /* Sched scan will be restarted by mac80211 in
1795 * restart_hw, so do not report if FW is about to be
1796 * restarted.
1797 */
1798 if ((mvm->scan_status & IWL_MVM_SCAN_SCHED) && !mvm->restart_fw)
1799 ieee80211_sched_scan_stopped(mvm->hw);
David Spinadel4ffb3652015-03-10 10:06:02 +02001800 }
1801}