blob: d126245c48dea219d2161221a56dd0709cfd35f8 [file] [log] [blame]
Emmanuel Grumbach931d4162013-01-17 09:42:25 +02001/******************************************************************************
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 *
8 * Copyright(c) 2013 Intel Corporation. All rights reserved.
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of version 2 of the GNU General Public License as
12 * published by the Free Software Foundation.
13 *
14 * This program is distributed in the hope that it will be useful, but
15 * WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
17 * General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
22 * USA
23 *
24 * The full GNU General Public License is included in this distribution
25 * in the file called COPYING.
26 *
27 * Contact Information:
28 * Intel Linux Wireless <ilw@linux.intel.com>
29 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
30 *
31 * BSD LICENSE
32 *
33 * Copyright(c) 2013 Intel Corporation. All rights reserved.
34 * All rights reserved.
35 *
36 * Redistribution and use in source and binary forms, with or without
37 * modification, are permitted provided that the following conditions
38 * are met:
39 *
40 * * Redistributions of source code must retain the above copyright
41 * notice, this list of conditions and the following disclaimer.
42 * * Redistributions in binary form must reproduce the above copyright
43 * notice, this list of conditions and the following disclaimer in
44 * the documentation and/or other materials provided with the
45 * distribution.
46 * * Neither the name Intel Corporation nor the names of its
47 * contributors may be used to endorse or promote products derived
48 * from this software without specific prior written permission.
49 *
50 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
51 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
52 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
53 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
54 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
55 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
56 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
57 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
58 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
59 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
60 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
61 *
62 *****************************************************************************/
63
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +020064#include <net/mac80211.h>
65
Emmanuel Grumbach931d4162013-01-17 09:42:25 +020066#include "fw-api-bt-coex.h"
67#include "iwl-modparams.h"
68#include "mvm.h"
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +020069#include "iwl-debug.h"
Emmanuel Grumbach931d4162013-01-17 09:42:25 +020070
71#define EVENT_PRIO_ANT(_evt, _prio, _shrd_ant) \
72 [(_evt)] = (((_prio) << BT_COEX_PRIO_TBL_PRIO_POS) | \
73 ((_shrd_ant) << BT_COEX_PRIO_TBL_SHRD_ANT_POS))
74
75static const u8 iwl_bt_prio_tbl[BT_COEX_PRIO_TBL_EVT_MAX] = {
76 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_INIT_CALIB1,
77 BT_COEX_PRIO_TBL_PRIO_BYPASS, 0),
78 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_INIT_CALIB2,
79 BT_COEX_PRIO_TBL_PRIO_BYPASS, 1),
80 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_LOW1,
81 BT_COEX_PRIO_TBL_PRIO_LOW, 0),
82 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_LOW2,
83 BT_COEX_PRIO_TBL_PRIO_LOW, 1),
84 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_HIGH1,
85 BT_COEX_PRIO_TBL_PRIO_HIGH, 0),
86 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_HIGH2,
87 BT_COEX_PRIO_TBL_PRIO_HIGH, 1),
88 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_DTIM,
89 BT_COEX_PRIO_TBL_DISABLED, 0),
90 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_SCAN52,
91 BT_COEX_PRIO_TBL_PRIO_COEX_OFF, 0),
92 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_SCAN24,
93 BT_COEX_PRIO_TBL_PRIO_COEX_ON, 0),
94 EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_IDLE,
95 BT_COEX_PRIO_TBL_PRIO_COEX_IDLE, 0),
96 0, 0, 0, 0, 0, 0,
97};
98
99#undef EVENT_PRIO_ANT
100
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200101#define BT_ENABLE_REDUCED_TXPOWER_THRESHOLD (-62)
102#define BT_DISABLE_REDUCED_TXPOWER_THRESHOLD (-65)
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300103#define BT_ANTENNA_COUPLING_THRESHOLD (30)
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200104
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200105int iwl_send_bt_prio_tbl(struct iwl_mvm *mvm)
106{
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300107 if (!(mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_NEWBT_COEX))
108 return 0;
109
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200110 return iwl_mvm_send_cmd_pdu(mvm, BT_COEX_PRIO_TABLE, CMD_SYNC,
111 sizeof(struct iwl_bt_coex_prio_tbl_cmd),
112 &iwl_bt_prio_tbl);
113}
114
Emmanuel Grumbach2de13ca2013-06-30 07:43:28 +0300115const u32 iwl_bt_ack_kill_msk[BT_KILL_MSK_MAX] = {
Emmanuel Grumbach5b7e6622013-03-10 20:15:24 +0200116 [BT_KILL_MSK_DEFAULT] = 0xffff0000,
117 [BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
118 [BT_KILL_MSK_REDUCED_TXPOW] = 0,
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200119};
120
Emmanuel Grumbach2de13ca2013-06-30 07:43:28 +0300121const u32 iwl_bt_cts_kill_msk[BT_KILL_MSK_MAX] = {
Emmanuel Grumbach5b7e6622013-03-10 20:15:24 +0200122 [BT_KILL_MSK_DEFAULT] = 0xffff0000,
123 [BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
124 [BT_KILL_MSK_REDUCED_TXPOW] = 0,
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200125};
126
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300127static const __le32 iwl_bt_prio_boost[BT_COEX_BOOST_SIZE] = {
128 cpu_to_le32(0xf0f0f0f0),
129 cpu_to_le32(0xc0c0c0c0),
130 cpu_to_le32(0xfcfcfcfc),
131 cpu_to_le32(0xff00ff00),
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200132};
133
Emmanuel Grumbachd1d5e3c2013-09-11 13:33:28 +0300134static const __le32 iwl_single_shared_ant[BT_COEX_MAX_LUT][BT_COEX_LUT_SIZE] = {
135 {
136 cpu_to_le32(0x40000000),
137 cpu_to_le32(0x00000000),
138 cpu_to_le32(0x44000000),
139 cpu_to_le32(0x00000000),
140 cpu_to_le32(0x40000000),
141 cpu_to_le32(0x00000000),
142 cpu_to_le32(0x44000000),
143 cpu_to_le32(0x00000000),
144 cpu_to_le32(0xc0004000),
145 cpu_to_le32(0xf0005000),
146 cpu_to_le32(0xc0004000),
147 cpu_to_le32(0xf0005000),
148 },
149 {
150 cpu_to_le32(0x40000000),
151 cpu_to_le32(0x00000000),
152 cpu_to_le32(0x44000000),
153 cpu_to_le32(0x00000000),
154 cpu_to_le32(0x40000000),
155 cpu_to_le32(0x00000000),
156 cpu_to_le32(0x44000000),
157 cpu_to_le32(0x00000000),
158 cpu_to_le32(0xc0004000),
159 cpu_to_le32(0xf0005000),
160 cpu_to_le32(0xc0004000),
161 cpu_to_le32(0xf0005000),
162 },
163 {
164 cpu_to_le32(0x40000000),
165 cpu_to_le32(0x00000000),
166 cpu_to_le32(0x44000000),
167 cpu_to_le32(0x00000000),
168 cpu_to_le32(0x40000000),
169 cpu_to_le32(0x00000000),
170 cpu_to_le32(0x44000000),
171 cpu_to_le32(0x00000000),
172 cpu_to_le32(0xc0004000),
173 cpu_to_le32(0xf0005000),
174 cpu_to_le32(0xc0004000),
175 cpu_to_le32(0xf0005000),
176 },
177};
178
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300179static const __le32 iwl_combined_lookup[BT_COEX_MAX_LUT][BT_COEX_LUT_SIZE] = {
180 {
181 /* Tight */
182 cpu_to_le32(0xaaaaaaaa),
183 cpu_to_le32(0xaaaaaaaa),
184 cpu_to_le32(0xaeaaaaaa),
185 cpu_to_le32(0xaaaaaaaa),
186 cpu_to_le32(0xcc00ff28),
187 cpu_to_le32(0x0000aaaa),
188 cpu_to_le32(0xcc00aaaa),
189 cpu_to_le32(0x0000aaaa),
190 cpu_to_le32(0xc0004000),
191 cpu_to_le32(0x00000000),
192 cpu_to_le32(0xf0005000),
193 cpu_to_le32(0xf0005000),
194 },
195 {
196 /* Loose */
197 cpu_to_le32(0xaaaaaaaa),
198 cpu_to_le32(0xaaaaaaaa),
199 cpu_to_le32(0xaaaaaaaa),
200 cpu_to_le32(0xaaaaaaaa),
201 cpu_to_le32(0xcc00ff28),
202 cpu_to_le32(0x0000aaaa),
203 cpu_to_le32(0xcc00aaaa),
204 cpu_to_le32(0x0000aaaa),
205 cpu_to_le32(0x00000000),
206 cpu_to_le32(0x00000000),
207 cpu_to_le32(0xf0005000),
208 cpu_to_le32(0xf0005000),
209 },
210 {
211 /* Tx Tx disabled */
212 cpu_to_le32(0xaaaaaaaa),
213 cpu_to_le32(0xaaaaaaaa),
214 cpu_to_le32(0xaaaaaaaa),
215 cpu_to_le32(0xaaaaaaaa),
216 cpu_to_le32(0xcc00ff28),
217 cpu_to_le32(0x0000aaaa),
218 cpu_to_le32(0xcc00aaaa),
219 cpu_to_le32(0x0000aaaa),
220 cpu_to_le32(0xC0004000),
221 cpu_to_le32(0xC0004000),
222 cpu_to_le32(0xF0005000),
223 cpu_to_le32(0xF0005000),
224 },
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200225};
226
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300227/* 20MHz / 40MHz below / 40Mhz above*/
228static const __le64 iwl_ci_mask[][3] = {
229 /* dummy entry for channel 0 */
230 {cpu_to_le64(0), cpu_to_le64(0), cpu_to_le64(0)},
231 {
232 cpu_to_le64(0x0000001FFFULL),
233 cpu_to_le64(0x0ULL),
234 cpu_to_le64(0x00007FFFFFULL),
235 },
236 {
237 cpu_to_le64(0x000000FFFFULL),
238 cpu_to_le64(0x0ULL),
239 cpu_to_le64(0x0003FFFFFFULL),
240 },
241 {
242 cpu_to_le64(0x000003FFFCULL),
243 cpu_to_le64(0x0ULL),
244 cpu_to_le64(0x000FFFFFFCULL),
245 },
246 {
247 cpu_to_le64(0x00001FFFE0ULL),
248 cpu_to_le64(0x0ULL),
249 cpu_to_le64(0x007FFFFFE0ULL),
250 },
251 {
252 cpu_to_le64(0x00007FFF80ULL),
253 cpu_to_le64(0x00007FFFFFULL),
254 cpu_to_le64(0x01FFFFFF80ULL),
255 },
256 {
257 cpu_to_le64(0x0003FFFC00ULL),
258 cpu_to_le64(0x0003FFFFFFULL),
259 cpu_to_le64(0x0FFFFFFC00ULL),
260 },
261 {
262 cpu_to_le64(0x000FFFF000ULL),
263 cpu_to_le64(0x000FFFFFFCULL),
264 cpu_to_le64(0x3FFFFFF000ULL),
265 },
266 {
267 cpu_to_le64(0x007FFF8000ULL),
268 cpu_to_le64(0x007FFFFFE0ULL),
269 cpu_to_le64(0xFFFFFF8000ULL),
270 },
271 {
272 cpu_to_le64(0x01FFFE0000ULL),
273 cpu_to_le64(0x01FFFFFF80ULL),
274 cpu_to_le64(0xFFFFFE0000ULL),
275 },
276 {
277 cpu_to_le64(0x0FFFF00000ULL),
278 cpu_to_le64(0x0FFFFFFC00ULL),
279 cpu_to_le64(0x0ULL),
280 },
281 {
282 cpu_to_le64(0x3FFFC00000ULL),
283 cpu_to_le64(0x3FFFFFF000ULL),
284 cpu_to_le64(0x0)
285 },
286 {
287 cpu_to_le64(0xFFFE000000ULL),
288 cpu_to_le64(0xFFFFFF8000ULL),
289 cpu_to_le64(0x0)
290 },
291 {
292 cpu_to_le64(0xFFF8000000ULL),
293 cpu_to_le64(0xFFFFFE0000ULL),
294 cpu_to_le64(0x0)
295 },
296 {
297 cpu_to_le64(0xFE00000000ULL),
298 cpu_to_le64(0x0ULL),
299 cpu_to_le64(0x0)
300 },
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200301};
302
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300303static const __le32 iwl_bt_mprio_lut[BT_COEX_MULTI_PRIO_LUT_SIZE] = {
304 cpu_to_le32(0x22002200),
305 cpu_to_le32(0x33113311),
Emmanuel Grumbache715c3a2013-06-18 05:34:58 +0300306};
307
Emmanuel Grumbach4515f302013-06-30 07:51:54 +0300308static enum iwl_bt_coex_lut_type
309iwl_get_coex_type(struct iwl_mvm *mvm, const struct ieee80211_vif *vif)
310{
311 struct ieee80211_chanctx_conf *chanctx_conf;
312 enum iwl_bt_coex_lut_type ret;
313 u16 phy_ctx_id;
314
Emmanuel Grumbach9145d152013-07-18 08:45:41 +0300315 /*
316 * Checking that we hold mvm->mutex is a good idea, but the rate
317 * control can't acquire the mutex since it runs in Tx path.
318 * So this is racy in that case, but in the worst case, the AMPDU
319 * size limit will be wrong for a short time which is not a big
320 * issue.
321 */
Emmanuel Grumbach4515f302013-06-30 07:51:54 +0300322
323 rcu_read_lock();
324
325 chanctx_conf = rcu_dereference(vif->chanctx_conf);
326
327 if (!chanctx_conf ||
328 chanctx_conf->def.chan->band != IEEE80211_BAND_2GHZ) {
329 rcu_read_unlock();
330 return BT_COEX_LOOSE_LUT;
331 }
332
333 ret = BT_COEX_TX_DIS_LUT;
334
Emmanuel Grumbach39149912013-07-14 13:40:21 +0300335 if (mvm->cfg->bt_shared_single_ant) {
336 rcu_read_unlock();
337 return ret;
338 }
339
Emmanuel Grumbach4515f302013-06-30 07:51:54 +0300340 phy_ctx_id = *((u16 *)chanctx_conf->drv_priv);
341
342 if (mvm->last_bt_ci_cmd.primary_ch_phy_id == phy_ctx_id)
343 ret = le32_to_cpu(mvm->last_bt_notif.primary_ch_lut);
344 else if (mvm->last_bt_ci_cmd.secondary_ch_phy_id == phy_ctx_id)
345 ret = le32_to_cpu(mvm->last_bt_notif.secondary_ch_lut);
346 /* else - default = TX TX disallowed */
347
348 rcu_read_unlock();
349
350 return ret;
351}
352
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200353int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
354{
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300355 struct iwl_bt_coex_cmd *bt_cmd;
356 struct iwl_host_cmd cmd = {
357 .id = BT_CONFIG,
358 .len = { sizeof(*bt_cmd), },
359 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
360 .flags = CMD_SYNC,
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200361 };
362 int ret;
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300363 u32 flags;
364
365 if (!(mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_NEWBT_COEX))
366 return 0;
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200367
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300368 bt_cmd = kzalloc(sizeof(*bt_cmd), GFP_KERNEL);
369 if (!bt_cmd)
370 return -ENOMEM;
371 cmd.data[0] = bt_cmd;
372
373 bt_cmd->max_kill = 5;
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300374 bt_cmd->bt4_antenna_isolation_thr = BT_ANTENNA_COUPLING_THRESHOLD,
375 bt_cmd->bt4_antenna_isolation = iwlwifi_mod_params.ant_coupling,
376 bt_cmd->bt4_tx_tx_delta_freq_thr = 15,
377 bt_cmd->bt4_tx_rx_max_freq0 = 15,
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300378
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300379 flags = iwlwifi_mod_params.bt_coex_active ?
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300380 BT_COEX_NW : BT_COEX_DISABLE;
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300381 flags |= BT_CH_PRIMARY_EN | BT_CH_SECONDARY_EN | BT_SYNC_2_BT_DISABLE;
382 bt_cmd->flags = cpu_to_le32(flags);
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300383
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300384 bt_cmd->valid_bit_msk = cpu_to_le32(BT_VALID_ENABLE |
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300385 BT_VALID_BT_PRIO_BOOST |
386 BT_VALID_MAX_KILL |
387 BT_VALID_3W_TMRS |
388 BT_VALID_KILL_ACK |
389 BT_VALID_KILL_CTS |
390 BT_VALID_REDUCED_TX_POWER |
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300391 BT_VALID_LUT |
392 BT_VALID_WIFI_RX_SW_PRIO_BOOST |
393 BT_VALID_WIFI_TX_SW_PRIO_BOOST |
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300394 BT_VALID_CORUN_LUT_20 |
395 BT_VALID_CORUN_LUT_40 |
396 BT_VALID_ANT_ISOLATION |
397 BT_VALID_ANT_ISOLATION_THRS |
398 BT_VALID_TXTX_DELTA_FREQ_THRS |
Emmanuel Grumbachb9c509c2013-11-28 14:58:20 +0200399 BT_VALID_TXRX_MAX_FREQ_0 |
400 BT_VALID_SYNC_TO_SCO);
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300401
Emmanuel Grumbachd1d5e3c2013-09-11 13:33:28 +0300402 if (mvm->cfg->bt_shared_single_ant)
403 memcpy(&bt_cmd->decision_lut, iwl_single_shared_ant,
404 sizeof(iwl_single_shared_ant));
405 else
406 memcpy(&bt_cmd->decision_lut, iwl_combined_lookup,
407 sizeof(iwl_combined_lookup));
408
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300409 memcpy(&bt_cmd->bt_prio_boost, iwl_bt_prio_boost,
410 sizeof(iwl_bt_prio_boost));
411 memcpy(&bt_cmd->bt4_multiprio_lut, iwl_bt_mprio_lut,
412 sizeof(iwl_bt_mprio_lut));
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300413 bt_cmd->kill_ack_msk =
414 cpu_to_le32(iwl_bt_ack_kill_msk[BT_KILL_MSK_DEFAULT]);
415 bt_cmd->kill_cts_msk =
416 cpu_to_le32(iwl_bt_cts_kill_msk[BT_KILL_MSK_DEFAULT]);
417
418 memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300419 memset(&mvm->last_bt_ci_cmd, 0, sizeof(mvm->last_bt_ci_cmd));
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300420
421 ret = iwl_mvm_send_cmd(mvm, &cmd);
422
423 kfree(bt_cmd);
424 return ret;
Emmanuel Grumbach931d4162013-01-17 09:42:25 +0200425}
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +0200426
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200427static int iwl_mvm_bt_udpate_ctrl_kill_msk(struct iwl_mvm *mvm,
428 bool reduced_tx_power)
429{
430 enum iwl_bt_kill_msk bt_kill_msk;
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300431 struct iwl_bt_coex_cmd *bt_cmd;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200432 struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300433 struct iwl_host_cmd cmd = {
434 .id = BT_CONFIG,
435 .data[0] = &bt_cmd,
436 .len = { sizeof(*bt_cmd), },
437 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
438 .flags = CMD_SYNC,
439 };
440 int ret = 0;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200441
442 lockdep_assert_held(&mvm->mutex);
443
444 if (reduced_tx_power) {
445 /* Reduced Tx power has precedence on the type of the profile */
446 bt_kill_msk = BT_KILL_MSK_REDUCED_TXPOW;
447 } else {
448 /* Low latency BT profile is active: give higher prio to BT */
449 if (BT_MBOX_MSG(notif, 3, SCO_STATE) ||
450 BT_MBOX_MSG(notif, 3, A2DP_STATE) ||
451 BT_MBOX_MSG(notif, 3, SNIFF_STATE))
452 bt_kill_msk = BT_KILL_MSK_SCO_HID_A2DP;
453 else
454 bt_kill_msk = BT_KILL_MSK_DEFAULT;
455 }
456
457 IWL_DEBUG_COEX(mvm,
458 "Update kill_msk: %d - SCO %sactive A2DP %sactive SNIFF %sactive\n",
459 bt_kill_msk,
460 BT_MBOX_MSG(notif, 3, SCO_STATE) ? "" : "in",
461 BT_MBOX_MSG(notif, 3, A2DP_STATE) ? "" : "in",
462 BT_MBOX_MSG(notif, 3, SNIFF_STATE) ? "" : "in");
463
464 /* Don't send HCMD if there is no update */
465 if (bt_kill_msk == mvm->bt_kill_msk)
466 return 0;
467
468 mvm->bt_kill_msk = bt_kill_msk;
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300469
470 bt_cmd = kzalloc(sizeof(*bt_cmd), GFP_KERNEL);
471 if (!bt_cmd)
472 return -ENOMEM;
473 cmd.data[0] = bt_cmd;
Emmanuel Grumbach7352cac2013-10-14 18:52:23 +0300474 bt_cmd->flags = cpu_to_le32(BT_COEX_NW);
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300475
476 bt_cmd->kill_ack_msk = cpu_to_le32(iwl_bt_ack_kill_msk[bt_kill_msk]);
477 bt_cmd->kill_cts_msk = cpu_to_le32(iwl_bt_cts_kill_msk[bt_kill_msk]);
Emmanuel Grumbach7352cac2013-10-14 18:52:23 +0300478 bt_cmd->valid_bit_msk |= cpu_to_le32(BT_VALID_ENABLE |
479 BT_VALID_KILL_ACK |
480 BT_VALID_KILL_CTS);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200481
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300482 IWL_DEBUG_COEX(mvm, "ACK Kill msk = 0x%08x, CTS Kill msk = 0x%08x\n",
483 iwl_bt_ack_kill_msk[bt_kill_msk],
484 iwl_bt_cts_kill_msk[bt_kill_msk]);
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300485
486 ret = iwl_mvm_send_cmd(mvm, &cmd);
487
488 kfree(bt_cmd);
489 return ret;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200490}
491
492static int iwl_mvm_bt_coex_reduced_txp(struct iwl_mvm *mvm, u8 sta_id,
493 bool enable)
494{
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300495 struct iwl_bt_coex_cmd *bt_cmd;
496 /* Send ASYNC since this can be sent from an atomic context */
497 struct iwl_host_cmd cmd = {
498 .id = BT_CONFIG,
499 .len = { sizeof(*bt_cmd), },
500 .dataflags = { IWL_HCMD_DFL_DUP, },
501 .flags = CMD_ASYNC,
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200502 };
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300503
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200504 struct ieee80211_sta *sta;
505 struct iwl_mvm_sta *mvmsta;
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300506 int ret;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200507
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200508 if (sta_id == IWL_MVM_STATION_COUNT)
509 return 0;
510
511 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[sta_id],
512 lockdep_is_held(&mvm->mutex));
Emmanuel Grumbach22cba0c2013-10-21 11:03:53 +0300513
514 /* This can happen if the station has been removed right now */
515 if (IS_ERR_OR_NULL(sta))
516 return 0;
517
Johannes Berg5b577a92013-11-14 18:20:04 +0100518 mvmsta = iwl_mvm_sta_from_mac80211(sta);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200519
520 /* nothing to do */
521 if (mvmsta->bt_reduced_txpower == enable)
522 return 0;
523
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300524 bt_cmd = kzalloc(sizeof(*bt_cmd), GFP_ATOMIC);
525 if (!bt_cmd)
526 return -ENOMEM;
527 cmd.data[0] = bt_cmd;
Emmanuel Grumbach7352cac2013-10-14 18:52:23 +0300528 bt_cmd->flags = cpu_to_le32(BT_COEX_NW);
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300529
Emmanuel Grumbach7352cac2013-10-14 18:52:23 +0300530 bt_cmd->valid_bit_msk =
531 cpu_to_le32(BT_VALID_ENABLE | BT_VALID_REDUCED_TX_POWER);
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300532 bt_cmd->bt_reduced_tx_power = sta_id;
533
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200534 if (enable)
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300535 bt_cmd->bt_reduced_tx_power |= BT_REDUCED_TX_POWER_BIT;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200536
537 IWL_DEBUG_COEX(mvm, "%sable reduced Tx Power for sta %d\n",
538 enable ? "en" : "dis", sta_id);
539
540 mvmsta->bt_reduced_txpower = enable;
541
Emmanuel Grumbach03e304e2013-06-26 15:54:34 +0300542 ret = iwl_mvm_send_cmd(mvm, &cmd);
543
544 kfree(bt_cmd);
545 return ret;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200546}
547
548struct iwl_bt_iterator_data {
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200549 struct iwl_bt_coex_profile_notif *notif;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200550 struct iwl_mvm *mvm;
551 u32 num_bss_ifaces;
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300552 bool reduced_tx_power;
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300553 struct ieee80211_chanctx_conf *primary;
554 struct ieee80211_chanctx_conf *secondary;
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200555};
556
Emmanuel Grumbachf6fc5772013-09-08 08:57:15 +0300557static inline
558void iwl_mvm_bt_coex_enable_rssi_event(struct iwl_mvm *mvm,
559 struct ieee80211_vif *vif,
560 bool enable, int rssi)
561{
562 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
563
564 mvmvif->bf_data.last_bt_coex_event = rssi;
565 mvmvif->bf_data.bt_coex_max_thold =
566 enable ? BT_ENABLE_REDUCED_TXPOWER_THRESHOLD : 0;
567 mvmvif->bf_data.bt_coex_min_thold =
568 enable ? BT_DISABLE_REDUCED_TXPOWER_THRESHOLD : 0;
569}
570
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300571/* must be called under rcu_read_lock */
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200572static void iwl_mvm_bt_notif_iterator(void *_data, u8 *mac,
573 struct ieee80211_vif *vif)
574{
575 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200576 struct iwl_bt_iterator_data *data = _data;
577 struct iwl_mvm *mvm = data->mvm;
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200578 struct ieee80211_chanctx_conf *chanctx_conf;
579 enum ieee80211_smps_mode smps_mode;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200580 int ave_rssi;
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200581
Eytan Lifshitz9ee718a2013-05-19 19:14:41 +0300582 lockdep_assert_held(&mvm->mutex);
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200583
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300584 if (vif->type != NL80211_IFTYPE_STATION &&
585 vif->type != NL80211_IFTYPE_AP)
586 return;
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200587
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200588 smps_mode = IEEE80211_SMPS_AUTOMATIC;
589
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300590 chanctx_conf = rcu_dereference(vif->chanctx_conf);
591
592 /* If channel context is invalid or not on 2.4GHz .. */
593 if ((!chanctx_conf ||
594 chanctx_conf->def.chan->band != IEEE80211_BAND_2GHZ)) {
595 /* ... and it is an associated STATION, relax constraints */
596 if (vif->type == NL80211_IFTYPE_STATION && vif->bss_conf.assoc)
597 iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX,
598 smps_mode);
Emmanuel Grumbachf6fc5772013-09-08 08:57:15 +0300599 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, false, 0);
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300600 return;
601 }
602
603 /* SoftAP / GO will always be primary */
604 if (vif->type == NL80211_IFTYPE_AP) {
Johannes Berg5023d962013-07-31 14:07:43 +0200605 if (!mvmvif->ap_ibss_active)
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300606 return;
607
608 /* the Ack / Cts kill mask must be default if AP / GO */
609 data->reduced_tx_power = false;
610
611 if (chanctx_conf == data->primary)
612 return;
613
614 /* downgrade the current primary no matter what its type is */
615 data->secondary = data->primary;
616 data->primary = chanctx_conf;
617 return;
618 }
619
Emmanuel Grumbach39149912013-07-14 13:40:21 +0300620 data->num_bss_ifaces++;
621
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300622 /* we are now a STA / P2P Client, and take associated ones only */
Emmanuel Grumbach41069b42013-06-25 21:49:19 +0300623 if (!vif->bss_conf.assoc)
624 return;
625
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300626 /* STA / P2P Client, try to be primary if first vif */
627 if (!data->primary || data->primary == chanctx_conf)
628 data->primary = chanctx_conf;
629 else if (!data->secondary)
630 /* if secondary is not NULL, it might be a GO */
631 data->secondary = chanctx_conf;
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200632
Emmanuel Grumbachda8f8362013-10-06 11:03:17 +0300633 if (le32_to_cpu(data->notif->bt_activity_grading) >= BT_HIGH_TRAFFIC)
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200634 smps_mode = IEEE80211_SMPS_STATIC;
Emmanuel Grumbachda8f8362013-10-06 11:03:17 +0300635 else if (le32_to_cpu(data->notif->bt_activity_grading) >=
636 BT_LOW_TRAFFIC)
637 smps_mode = IEEE80211_SMPS_DYNAMIC;
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200638
639 IWL_DEBUG_COEX(data->mvm,
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300640 "mac %d: bt_status %d bt_activity_grading %d smps_req %d\n",
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200641 mvmvif->id, data->notif->bt_status,
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300642 data->notif->bt_activity_grading, smps_mode);
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200643
Eytan Lifshitz9ee718a2013-05-19 19:14:41 +0300644 iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX, smps_mode);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200645
646 /* don't reduce the Tx power if in loose scheme */
Emmanuel Grumbach39149912013-07-14 13:40:21 +0300647 if (iwl_get_coex_type(mvm, vif) == BT_COEX_LOOSE_LUT ||
648 mvm->cfg->bt_shared_single_ant) {
649 data->reduced_tx_power = false;
Emmanuel Grumbachf6fc5772013-09-08 08:57:15 +0300650 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, false, 0);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200651 return;
Emmanuel Grumbach39149912013-07-14 13:40:21 +0300652 }
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200653
Emmanuel Grumbach4515f302013-06-30 07:51:54 +0300654 /* reduced Txpower only if BT is on, so ...*/
Emmanuel Grumbach0af88352013-10-15 12:37:38 +0300655 if (!data->notif->bt_status) {
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200656 /* ... cancel reduced Tx power ... */
657 if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
658 IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300659 data->reduced_tx_power = false;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200660
661 /* ... and there is no need to get reports on RSSI any more. */
Emmanuel Grumbachf6fc5772013-09-08 08:57:15 +0300662 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, false, 0);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200663 return;
664 }
665
Andrei Otcheretianski911222b2013-07-21 17:37:19 +0300666 /* try to get the avg rssi from fw */
667 ave_rssi = mvmvif->bf_data.ave_beacon_signal;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200668
669 /* if the RSSI isn't valid, fake it is very low */
670 if (!ave_rssi)
671 ave_rssi = -100;
672 if (ave_rssi > BT_ENABLE_REDUCED_TXPOWER_THRESHOLD) {
673 if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true))
674 IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
675
676 /*
677 * bt_kill_msk can be BT_KILL_MSK_REDUCED_TXPOW only if all the
678 * BSS / P2P clients have rssi above threshold.
679 * We set the bt_kill_msk to BT_KILL_MSK_REDUCED_TXPOW before
680 * the iteration, if one interface's rssi isn't good enough,
681 * bt_kill_msk will be set to default values.
682 */
683 } else if (ave_rssi < BT_DISABLE_REDUCED_TXPOWER_THRESHOLD) {
684 if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
685 IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
686
687 /*
688 * One interface hasn't rssi above threshold, bt_kill_msk must
689 * be set to default values.
690 */
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300691 data->reduced_tx_power = false;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200692 }
693
694 /* Begin to monitor the RSSI: it may influence the reduced Tx power */
Emmanuel Grumbachf6fc5772013-09-08 08:57:15 +0300695 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, true, ave_rssi);
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200696}
697
Emmanuel Grumbachd37cac92013-03-29 14:56:19 +0300698static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm *mvm)
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +0200699{
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200700 struct iwl_bt_iterator_data data = {
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200701 .mvm = mvm,
Emmanuel Grumbachd37cac92013-03-29 14:56:19 +0300702 .notif = &mvm->last_bt_notif,
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300703 .reduced_tx_power = true,
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200704 };
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300705 struct iwl_bt_coex_ci_cmd cmd = {};
706 u8 ci_bw_idx;
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +0200707
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300708 rcu_read_lock();
Emmanuel Grumbach7da052b2013-02-10 17:06:17 +0200709 ieee80211_iterate_active_interfaces_atomic(
710 mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
711 iwl_mvm_bt_notif_iterator, &data);
712
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300713 if (data.primary) {
714 struct ieee80211_chanctx_conf *chan = data.primary;
715 if (WARN_ON(!chan->def.chan)) {
716 rcu_read_unlock();
717 return;
718 }
719
720 if (chan->def.width < NL80211_CHAN_WIDTH_40) {
721 ci_bw_idx = 0;
722 cmd.co_run_bw_primary = 0;
723 } else {
724 cmd.co_run_bw_primary = 1;
725 if (chan->def.center_freq1 >
726 chan->def.chan->center_freq)
727 ci_bw_idx = 2;
728 else
729 ci_bw_idx = 1;
730 }
731
732 cmd.bt_primary_ci =
733 iwl_ci_mask[chan->def.chan->hw_value][ci_bw_idx];
734 cmd.primary_ch_phy_id = *((u16 *)data.primary->drv_priv);
735 }
736
737 if (data.secondary) {
738 struct ieee80211_chanctx_conf *chan = data.secondary;
739 if (WARN_ON(!data.secondary->def.chan)) {
740 rcu_read_unlock();
741 return;
742 }
743
744 if (chan->def.width < NL80211_CHAN_WIDTH_40) {
745 ci_bw_idx = 0;
746 cmd.co_run_bw_secondary = 0;
747 } else {
748 cmd.co_run_bw_secondary = 1;
749 if (chan->def.center_freq1 >
750 chan->def.chan->center_freq)
751 ci_bw_idx = 2;
752 else
753 ci_bw_idx = 1;
754 }
755
756 cmd.bt_secondary_ci =
757 iwl_ci_mask[chan->def.chan->hw_value][ci_bw_idx];
Emmanuel Grumbachc92f06a2013-10-29 22:50:49 +0200758 cmd.secondary_ch_phy_id = *((u16 *)data.secondary->drv_priv);
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300759 }
760
761 rcu_read_unlock();
762
763 /* Don't spam the fw with the same command over and over */
764 if (memcmp(&cmd, &mvm->last_bt_ci_cmd, sizeof(cmd))) {
765 if (iwl_mvm_send_cmd_pdu(mvm, BT_COEX_CI, CMD_SYNC,
766 sizeof(cmd), &cmd))
767 IWL_ERR(mvm, "Failed to send BT_CI cmd");
768 memcpy(&mvm->last_bt_ci_cmd, &cmd, sizeof(cmd));
769 }
770
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200771 /*
772 * If there are no BSS / P2P client interfaces, reduced Tx Power is
773 * irrelevant since it is based on the RSSI coming from the beacon.
774 * Use BT_KILL_MSK_DEFAULT in that case.
775 */
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300776 data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +0200777
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300778 if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200779 IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200780}
781
782/* upon association, the fw will send in BT Coex notification */
783int iwl_mvm_rx_bt_coex_notif(struct iwl_mvm *mvm,
784 struct iwl_rx_cmd_buffer *rxb,
785 struct iwl_device_cmd *dev_cmd)
786{
787 struct iwl_rx_packet *pkt = rxb_addr(rxb);
788 struct iwl_bt_coex_profile_notif *notif = (void *)pkt->data;
789
790
791 IWL_DEBUG_COEX(mvm, "BT Coex Notification received\n");
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300792 IWL_DEBUG_COEX(mvm, "\tBT status: %s\n",
793 notif->bt_status ? "ON" : "OFF");
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200794 IWL_DEBUG_COEX(mvm, "\tBT open conn %d\n", notif->bt_open_conn);
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300795 IWL_DEBUG_COEX(mvm, "\tBT ci compliance %d\n", notif->bt_ci_compliance);
796 IWL_DEBUG_COEX(mvm, "\tBT primary_ch_lut %d\n",
797 le32_to_cpu(notif->primary_ch_lut));
798 IWL_DEBUG_COEX(mvm, "\tBT secondary_ch_lut %d\n",
799 le32_to_cpu(notif->secondary_ch_lut));
800 IWL_DEBUG_COEX(mvm, "\tBT activity grading %d\n",
801 le32_to_cpu(notif->bt_activity_grading));
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200802 IWL_DEBUG_COEX(mvm, "\tBT agg traffic load %d\n",
803 notif->bt_agg_traffic_load);
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200804
Emmanuel Grumbachd37cac92013-03-29 14:56:19 +0300805 /* remember this notification for future use: rssi fluctuations */
806 memcpy(&mvm->last_bt_notif, notif, sizeof(mvm->last_bt_notif));
807
808 iwl_mvm_bt_coex_notif_handle(mvm);
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +0200809
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200810 /*
811 * This is an async handler for a notification, returning anything other
812 * than 0 doesn't make sense even if HCMD failed.
813 */
Emmanuel Grumbachf421f9c2013-01-17 14:20:29 +0200814 return 0;
815}
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200816
817static void iwl_mvm_bt_rssi_iterator(void *_data, u8 *mac,
818 struct ieee80211_vif *vif)
819{
820 struct iwl_mvm_vif *mvmvif = (void *)vif->drv_priv;
821 struct iwl_bt_iterator_data *data = _data;
822 struct iwl_mvm *mvm = data->mvm;
823
824 struct ieee80211_sta *sta;
825 struct iwl_mvm_sta *mvmsta;
826
Emmanuel Grumbachf6fc5772013-09-08 08:57:15 +0300827 struct ieee80211_chanctx_conf *chanctx_conf;
828
829 rcu_read_lock();
830 chanctx_conf = rcu_dereference(vif->chanctx_conf);
831 /* If channel context is invalid or not on 2.4GHz - don't count it */
832 if (!chanctx_conf ||
833 chanctx_conf->def.chan->band != IEEE80211_BAND_2GHZ) {
834 rcu_read_unlock();
835 return;
836 }
837 rcu_read_unlock();
838
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200839 if (vif->type != NL80211_IFTYPE_STATION ||
840 mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT)
841 return;
842
843 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id],
844 lockdep_is_held(&mvm->mutex));
Emmanuel Grumbach56c07a92013-10-21 11:03:53 +0300845
846 /* This can happen if the station has been removed right now */
847 if (IS_ERR_OR_NULL(sta))
848 return;
849
Johannes Berg5b577a92013-11-14 18:20:04 +0100850 mvmsta = iwl_mvm_sta_from_mac80211(sta);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200851
Emmanuel Grumbach8e0366f2013-06-25 21:57:08 +0300852 data->num_bss_ifaces++;
853
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200854 /*
855 * This interface doesn't support reduced Tx power (because of low
856 * RSSI probably), then set bt_kill_msk to default values.
857 */
858 if (!mvmsta->bt_reduced_txpower)
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300859 data->reduced_tx_power = false;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200860 /* else - possibly leave it to BT_KILL_MSK_REDUCED_TXPOW */
861}
862
863void iwl_mvm_bt_rssi_event(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
864 enum ieee80211_rssi_event rssi_event)
865{
866 struct iwl_mvm_vif *mvmvif = (void *)vif->drv_priv;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200867 struct iwl_bt_iterator_data data = {
868 .mvm = mvm,
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300869 .reduced_tx_power = true,
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200870 };
871 int ret;
872
Johannes Berg3dd1cd22013-10-02 12:05:24 +0200873 lockdep_assert_held(&mvm->mutex);
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200874
875 /* Rssi update while not associated ?! */
876 if (WARN_ON_ONCE(mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT))
Johannes Berg3dd1cd22013-10-02 12:05:24 +0200877 return;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200878
Emmanuel Grumbach4515f302013-06-30 07:51:54 +0300879 /* No BT - reports should be disabled */
Emmanuel Grumbach0af88352013-10-15 12:37:38 +0300880 if (!mvm->last_bt_notif.bt_status)
Johannes Berg3dd1cd22013-10-02 12:05:24 +0200881 return;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200882
883 IWL_DEBUG_COEX(mvm, "RSSI for %pM is now %s\n", vif->bss_conf.bssid,
884 rssi_event == RSSI_EVENT_HIGH ? "HIGH" : "LOW");
885
886 /*
887 * Check if rssi is good enough for reduced Tx power, but not in loose
888 * scheme.
889 */
Emmanuel Grumbach39149912013-07-14 13:40:21 +0300890 if (rssi_event == RSSI_EVENT_LOW || mvm->cfg->bt_shared_single_ant ||
Emmanuel Grumbach4515f302013-06-30 07:51:54 +0300891 iwl_get_coex_type(mvm, vif) == BT_COEX_LOOSE_LUT)
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200892 ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id,
893 false);
894 else
895 ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true);
896
897 if (ret)
898 IWL_ERR(mvm, "couldn't send BT_CONFIG HCMD upon RSSI event\n");
899
900 ieee80211_iterate_active_interfaces_atomic(
901 mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
902 iwl_mvm_bt_rssi_iterator, &data);
903
904 /*
905 * If there are no BSS / P2P client interfaces, reduced Tx Power is
906 * irrelevant since it is based on the RSSI coming from the beacon.
907 * Use BT_KILL_MSK_DEFAULT in that case.
908 */
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300909 data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200910
Emmanuel Grumbach9e511c32013-03-29 14:52:17 +0300911 if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200912 IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
Emmanuel Grumbach2b76ef12013-01-24 10:35:13 +0200913}
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200914
Emmanuel Grumbach9145d152013-07-18 08:45:41 +0300915#define LINK_QUAL_AGG_TIME_LIMIT_DEF (4000)
916#define LINK_QUAL_AGG_TIME_LIMIT_BT_ACT (1200)
917
918u16 iwl_mvm_bt_coex_agg_time_limit(struct iwl_mvm *mvm,
919 struct ieee80211_sta *sta)
920{
Johannes Berg5b577a92013-11-14 18:20:04 +0100921 struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
Emmanuel Grumbach9145d152013-07-18 08:45:41 +0300922 enum iwl_bt_coex_lut_type lut_type;
923
924 if (le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) <
Emmanuel Grumbachc2119352013-11-13 22:00:30 +0200925 BT_HIGH_TRAFFIC)
Emmanuel Grumbach9145d152013-07-18 08:45:41 +0300926 return LINK_QUAL_AGG_TIME_LIMIT_DEF;
927
928 lut_type = iwl_get_coex_type(mvm, mvmsta->vif);
929
930 if (lut_type == BT_COEX_LOOSE_LUT)
931 return LINK_QUAL_AGG_TIME_LIMIT_DEF;
932
933 /* tight coex, high bt traffic, reduce AGG time limit */
934 return LINK_QUAL_AGG_TIME_LIMIT_BT_ACT;
935}
936
Emmanuel Grumbachffa6c702013-10-06 11:41:20 +0300937bool iwl_mvm_bt_coex_is_mimo_allowed(struct iwl_mvm *mvm,
938 struct ieee80211_sta *sta)
939{
Johannes Berg5b577a92013-11-14 18:20:04 +0100940 struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
Emmanuel Grumbachffa6c702013-10-06 11:41:20 +0300941
942 if (le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) <
943 BT_HIGH_TRAFFIC)
944 return true;
945
946 /*
947 * In Tight, BT can't Rx while we Tx, so use both antennas since BT is
948 * already killed.
949 * In Loose, BT can Rx while we Tx, so forbid MIMO to let BT Rx while we
950 * Tx.
951 */
952 return iwl_get_coex_type(mvm, mvmsta->vif) == BT_COEX_TIGHT_LUT;
953}
954
Emmanuel Grumbach8e484f02013-10-02 15:02:25 +0300955void iwl_mvm_bt_coex_vif_change(struct iwl_mvm *mvm)
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200956{
Emmanuel Grumbachdac94da2013-06-18 07:35:27 +0300957 if (!(mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_NEWBT_COEX))
958 return;
959
Emmanuel Grumbachd37cac92013-03-29 14:56:19 +0300960 iwl_mvm_bt_coex_notif_handle(mvm);
Emmanuel Grumbach9166b1e2013-03-20 15:28:27 +0200961}