]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/net/wireless/iwlwifi/mvm/coex.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
iwlwifi: mvm: add Aux ROC request/response flow
[mirror_ubuntu-bionic-kernel.git] / drivers / net / wireless / iwlwifi / mvm / coex.c
CommitLineData
931d4160
EG		 1/******************************************************************************
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 *
51368bf7 8 * Copyright(c) 2013 - 2014 Intel Corporation. All rights reserved.
931d4160
EG		 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 *
51368bf7 33 * Copyright(c) 2013 - 2014 Intel Corporation. All rights reserved.
931d4160
EG		 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
ee7bea58
EG		 64#include <linux/ieee80211.h>
65#include <linux/etherdevice.h>
2b76ef13
EG		 66#include <net/mac80211.h>
67
5b7ff615 68#include "fw-api-coex.h"
931d4160
EG		 69#include "iwl-modparams.h"
70#include "mvm.h"
f421f9c3 71#include "iwl-debug.h"
931d4160 72
dac94da8 73#define BT_ANTENNA_COUPLING_THRESHOLD (30)
2b76ef13 74
2de13cae 75const u32 iwl_bt_ack_kill_msk[BT_KILL_MSK_MAX] = {
5b7e662b
EG		 76 [BT_KILL_MSK_DEFAULT] = 0xffff0000,
77 [BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
78 [BT_KILL_MSK_REDUCED_TXPOW] = 0,
931d4160
EG		 79};
80
2de13cae 81const u32 iwl_bt_cts_kill_msk[BT_KILL_MSK_MAX] = {
5b7e662b
EG		 82 [BT_KILL_MSK_DEFAULT] = 0xffff0000,
83 [BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
84 [BT_KILL_MSK_REDUCED_TXPOW] = 0,
931d4160
EG		 85};
86
dac94da8 87static const __le32 iwl_bt_prio_boost[BT_COEX_BOOST_SIZE] = {
2adc8949
EG		 88 cpu_to_le32(0xf0f0f0f0), /* 50% */
89 cpu_to_le32(0xc0c0c0c0), /* 25% */
90 cpu_to_le32(0xfcfcfcfc), /* 75% */
91 cpu_to_le32(0xfefefefe), /* 87.5% */
931d4160
EG		 92};
93
d1d5e3cd
EG		 94static const __le32 iwl_single_shared_ant[BT_COEX_MAX_LUT][BT_COEX_LUT_SIZE] = {
95 {
96 cpu_to_le32(0x40000000),
97 cpu_to_le32(0x00000000),
98 cpu_to_le32(0x44000000),
99 cpu_to_le32(0x00000000),
100 cpu_to_le32(0x40000000),
101 cpu_to_le32(0x00000000),
102 cpu_to_le32(0x44000000),
103 cpu_to_le32(0x00000000),
104 cpu_to_le32(0xc0004000),
105 cpu_to_le32(0xf0005000),
106 cpu_to_le32(0xc0004000),
107 cpu_to_le32(0xf0005000),
108 },
109 {
110 cpu_to_le32(0x40000000),
111 cpu_to_le32(0x00000000),
112 cpu_to_le32(0x44000000),
113 cpu_to_le32(0x00000000),
114 cpu_to_le32(0x40000000),
115 cpu_to_le32(0x00000000),
116 cpu_to_le32(0x44000000),
117 cpu_to_le32(0x00000000),
118 cpu_to_le32(0xc0004000),
119 cpu_to_le32(0xf0005000),
120 cpu_to_le32(0xc0004000),
121 cpu_to_le32(0xf0005000),
122 },
123 {
124 cpu_to_le32(0x40000000),
125 cpu_to_le32(0x00000000),
126 cpu_to_le32(0x44000000),
127 cpu_to_le32(0x00000000),
128 cpu_to_le32(0x40000000),
129 cpu_to_le32(0x00000000),
130 cpu_to_le32(0x44000000),
131 cpu_to_le32(0x00000000),
132 cpu_to_le32(0xc0004000),
133 cpu_to_le32(0xf0005000),
134 cpu_to_le32(0xc0004000),
135 cpu_to_le32(0xf0005000),
136 },
137};
138
dac94da8
EG		 139static const __le32 iwl_combined_lookup[BT_COEX_MAX_LUT][BT_COEX_LUT_SIZE] = {
140 {
141 /* Tight */
142 cpu_to_le32(0xaaaaaaaa),
143 cpu_to_le32(0xaaaaaaaa),
144 cpu_to_le32(0xaeaaaaaa),
145 cpu_to_le32(0xaaaaaaaa),
146 cpu_to_le32(0xcc00ff28),
147 cpu_to_le32(0x0000aaaa),
148 cpu_to_le32(0xcc00aaaa),
149 cpu_to_le32(0x0000aaaa),
150 cpu_to_le32(0xc0004000),
a6bc9280 151 cpu_to_le32(0x00004000),
dac94da8
EG		 152 cpu_to_le32(0xf0005000),
153 cpu_to_le32(0xf0005000),
154 },
155 {
156 /* Loose */
157 cpu_to_le32(0xaaaaaaaa),
158 cpu_to_le32(0xaaaaaaaa),
159 cpu_to_le32(0xaaaaaaaa),
160 cpu_to_le32(0xaaaaaaaa),
161 cpu_to_le32(0xcc00ff28),
162 cpu_to_le32(0x0000aaaa),
163 cpu_to_le32(0xcc00aaaa),
164 cpu_to_le32(0x0000aaaa),
165 cpu_to_le32(0x00000000),
166 cpu_to_le32(0x00000000),
167 cpu_to_le32(0xf0005000),
168 cpu_to_le32(0xf0005000),
169 },
170 {
171 /* Tx Tx disabled */
172 cpu_to_le32(0xaaaaaaaa),
173 cpu_to_le32(0xaaaaaaaa),
a6bc9280 174 cpu_to_le32(0xeeaaaaaa),
dac94da8
EG		 175 cpu_to_le32(0xaaaaaaaa),
176 cpu_to_le32(0xcc00ff28),
177 cpu_to_le32(0x0000aaaa),
178 cpu_to_le32(0xcc00aaaa),
179 cpu_to_le32(0x0000aaaa),
a6bc9280
EG		 180 cpu_to_le32(0xc0004000),
181 cpu_to_le32(0xc0004000),
182 cpu_to_le32(0xf0005000),
183 cpu_to_le32(0xf0005000),
dac94da8 184 },
931d4160
EG		 185};
186
dac94da8
EG		 187/* 20MHz / 40MHz below / 40Mhz above*/
188static const __le64 iwl_ci_mask[][3] = {
189 /* dummy entry for channel 0 */
190 {cpu_to_le64(0), cpu_to_le64(0), cpu_to_le64(0)},
191 {
192 cpu_to_le64(0x0000001FFFULL),
193 cpu_to_le64(0x0ULL),
194 cpu_to_le64(0x00007FFFFFULL),
195 },
196 {
197 cpu_to_le64(0x000000FFFFULL),
198 cpu_to_le64(0x0ULL),
199 cpu_to_le64(0x0003FFFFFFULL),
200 },
201 {
202 cpu_to_le64(0x000003FFFCULL),
203 cpu_to_le64(0x0ULL),
204 cpu_to_le64(0x000FFFFFFCULL),
205 },
206 {
207 cpu_to_le64(0x00001FFFE0ULL),
208 cpu_to_le64(0x0ULL),
209 cpu_to_le64(0x007FFFFFE0ULL),
210 },
211 {
212 cpu_to_le64(0x00007FFF80ULL),
213 cpu_to_le64(0x00007FFFFFULL),
214 cpu_to_le64(0x01FFFFFF80ULL),
215 },
216 {
217 cpu_to_le64(0x0003FFFC00ULL),
218 cpu_to_le64(0x0003FFFFFFULL),
219 cpu_to_le64(0x0FFFFFFC00ULL),
220 },
221 {
222 cpu_to_le64(0x000FFFF000ULL),
223 cpu_to_le64(0x000FFFFFFCULL),
224 cpu_to_le64(0x3FFFFFF000ULL),
225 },
226 {
227 cpu_to_le64(0x007FFF8000ULL),
228 cpu_to_le64(0x007FFFFFE0ULL),
229 cpu_to_le64(0xFFFFFF8000ULL),
230 },
231 {
232 cpu_to_le64(0x01FFFE0000ULL),
233 cpu_to_le64(0x01FFFFFF80ULL),
234 cpu_to_le64(0xFFFFFE0000ULL),
235 },
236 {
237 cpu_to_le64(0x0FFFF00000ULL),
238 cpu_to_le64(0x0FFFFFFC00ULL),
239 cpu_to_le64(0x0ULL),
240 },
241 {
242 cpu_to_le64(0x3FFFC00000ULL),
243 cpu_to_le64(0x3FFFFFF000ULL),
244 cpu_to_le64(0x0)
245 },
246 {
247 cpu_to_le64(0xFFFE000000ULL),
248 cpu_to_le64(0xFFFFFF8000ULL),
249 cpu_to_le64(0x0)
250 },
251 {
252 cpu_to_le64(0xFFF8000000ULL),
253 cpu_to_le64(0xFFFFFE0000ULL),
254 cpu_to_le64(0x0)
255 },
256 {
d2ccc902 257 cpu_to_le64(0xFFC0000000ULL),
dac94da8 258 cpu_to_le64(0x0ULL),
d2ccc902 259 cpu_to_le64(0x0ULL)
dac94da8 260 },
931d4160
EG		 261};
262
dac94da8 263static const __le32 iwl_bt_mprio_lut[BT_COEX_MULTI_PRIO_LUT_SIZE] = {
2adc8949
EG		 264 cpu_to_le32(0x28412201),
265 cpu_to_le32(0x11118451),
e715c3a9
EG		 266};
267
b9fae2d5
EG		 268struct corunning_block_luts {
269 u8 range;
270 __le32 lut20[BT_COEX_CORUN_LUT_SIZE];
271};
272
273/*
274 * Ranges for the antenna coupling calibration / co-running block LUT:
275 * LUT0: [ 0, 12[
276 * LUT1: [12, 20[
277 * LUT2: [20, 21[
278 * LUT3: [21, 23[
279 * LUT4: [23, 27[
280 * LUT5: [27, 30[
281 * LUT6: [30, 32[
282 * LUT7: [32, 33[
283 * LUT8: [33, - [
284 */
285static const struct corunning_block_luts antenna_coupling_ranges[] = {
286 {
287 .range = 0,
288 .lut20 = {
289 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
290 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
291 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
292 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
293 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
294 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
295 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
296 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
297 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
298 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
299 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
300 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
301 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
302 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
303 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
304 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
305 },
306 },
307 {
308 .range = 12,
309 .lut20 = {
310 cpu_to_le32(0x00000001), cpu_to_le32(0x00000000),
311 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
312 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
313 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
314 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
315 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
316 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
317 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
318 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
319 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
320 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
321 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
322 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
323 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
324 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
325 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
326 },
327 },
328 {
329 .range = 20,
330 .lut20 = {
331 cpu_to_le32(0x00000002), cpu_to_le32(0x00000000),
332 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
333 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
334 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
335 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
336 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
337 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
338 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
339 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
340 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
341 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
342 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
343 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
344 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
345 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
346 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
347 },
348 },
349 {
350 .range = 21,
351 .lut20 = {
352 cpu_to_le32(0x00000003), cpu_to_le32(0x00000000),
353 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
354 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
355 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
356 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
357 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
358 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
359 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
360 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
361 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
362 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
363 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
364 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
365 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
366 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
367 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
368 },
369 },
370 {
371 .range = 23,
372 .lut20 = {
373 cpu_to_le32(0x00000004), cpu_to_le32(0x00000000),
374 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
375 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
376 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
377 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
378 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
379 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
380 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
381 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
382 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
383 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
384 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
385 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
386 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
387 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
388 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
389 },
390 },
391 {
392 .range = 27,
393 .lut20 = {
394 cpu_to_le32(0x00000005), cpu_to_le32(0x00000000),
395 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
396 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
397 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
398 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
399 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
400 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
401 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
402 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
403 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
404 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
405 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
406 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
407 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
408 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
409 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
410 },
411 },
412 {
413 .range = 30,
414 .lut20 = {
415 cpu_to_le32(0x00000006), cpu_to_le32(0x00000000),
416 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
417 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
418 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
419 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
420 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
421 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
422 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
423 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
424 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
425 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
426 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
427 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
428 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
429 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
430 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
431 },
432 },
433 {
434 .range = 32,
435 .lut20 = {
436 cpu_to_le32(0x00000007), cpu_to_le32(0x00000000),
437 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
438 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
439 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
440 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
441 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
442 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
443 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
444 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
445 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
446 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
447 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
448 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
449 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
450 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
451 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
452 },
453 },
454 {
455 .range = 33,
456 .lut20 = {
457 cpu_to_le32(0x00000008), cpu_to_le32(0x00000000),
458 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
459 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
460 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
461 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
462 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
463 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
464 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
465 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
466 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
467 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
468 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
469 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
470 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
471 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
472 cpu_to_le32(0x00000000), cpu_to_le32(0x00000000),
473 },
474 },
475};
476
4515f30f
EG		 477static enum iwl_bt_coex_lut_type
478iwl_get_coex_type(struct iwl_mvm *mvm, const struct ieee80211_vif *vif)
479{
480 struct ieee80211_chanctx_conf *chanctx_conf;
481 enum iwl_bt_coex_lut_type ret;
482 u16 phy_ctx_id;
430a3bba 483 u32 primary_ch_phy_id, secondary_ch_phy_id;
4515f30f 484
9145d151
EG		 485 /*
486 * Checking that we hold mvm->mutex is a good idea, but the rate
487 * control can't acquire the mutex since it runs in Tx path.
488 * So this is racy in that case, but in the worst case, the AMPDU
489 * size limit will be wrong for a short time which is not a big
490 * issue.
491 */
4515f30f
EG		 492
493 rcu_read_lock();
494
495 chanctx_conf = rcu_dereference(vif->chanctx_conf);
496
497 if (!chanctx_conf ||
498 chanctx_conf->def.chan->band != IEEE80211_BAND_2GHZ) {
499 rcu_read_unlock();
7fa4fa0c 500 return BT_COEX_INVALID_LUT;
4515f30f
EG		 501 }
502
503 ret = BT_COEX_TX_DIS_LUT;
504
39149911
EG		 505 if (mvm->cfg->bt_shared_single_ant) {
506 rcu_read_unlock();
507 return ret;
508 }
509
4515f30f 510 phy_ctx_id = *((u16 *)chanctx_conf->drv_priv);
430a3bba
EG		 511 primary_ch_phy_id = le32_to_cpu(mvm->last_bt_ci_cmd.primary_ch_phy_id);
512 secondary_ch_phy_id =
513 le32_to_cpu(mvm->last_bt_ci_cmd.secondary_ch_phy_id);
4515f30f 514
430a3bba 515 if (primary_ch_phy_id == phy_ctx_id)
4515f30f 516 ret = le32_to_cpu(mvm->last_bt_notif.primary_ch_lut);
430a3bba 517 else if (secondary_ch_phy_id == phy_ctx_id)
4515f30f
EG		 518 ret = le32_to_cpu(mvm->last_bt_notif.secondary_ch_lut);
519 /* else - default = TX TX disallowed */
520
521 rcu_read_unlock();
522
523 return ret;
524}
525
931d4160
EG		 526int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
527{
430a3bba 528 struct iwl_bt_coex_cmd *bt_cmd;
03e304e4
EG		 529 struct iwl_host_cmd cmd = {
530 .id = BT_CONFIG,
531 .len = { sizeof(*bt_cmd), },
532 .dataflags = { IWL_HCMD_DFL_NOCOPY, },
931d4160
EG		 533 };
534 int ret;
430a3bba 535 u32 mode;
dac94da8 536
0ea8d043
EG		 537 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
538 return iwl_send_bt_init_conf_old(mvm);
539
03e304e4
EG		 540 bt_cmd = kzalloc(sizeof(*bt_cmd), GFP_KERNEL);
541 if (!bt_cmd)
542 return -ENOMEM;
543 cmd.data[0] = bt_cmd;
544
a39979a8
EG		 545 lockdep_assert_held(&mvm->mutex);
546
547 if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS)) {
430a3bba
EG		 548 u32 mode;
549
a39979a8 550 switch (mvm->bt_force_ant_mode) {
a39979a8 551 case BT_FORCE_ANT_BT:
430a3bba 552 mode = BT_COEX_BT;
a39979a8
EG		 553 break;
554 case BT_FORCE_ANT_WIFI:
430a3bba 555 mode = BT_COEX_WIFI;
a39979a8
EG		 556 break;
557 default:
558 WARN_ON(1);
430a3bba 559 mode = 0;
a39979a8
EG		 560 }
561
430a3bba 562 bt_cmd->mode = cpu_to_le32(mode);
a39979a8
EG		 563 goto send_cmd;
564 }
565
430a3bba
EG		 566 bt_cmd->max_kill = cpu_to_le32(5);
567 bt_cmd->bt4_antenna_isolation_thr =
568 cpu_to_le32(BT_ANTENNA_COUPLING_THRESHOLD);
569 bt_cmd->bt4_tx_tx_delta_freq_thr = cpu_to_le32(15);
570 bt_cmd->bt4_tx_rx_max_freq0 = cpu_to_le32(15);
571 bt_cmd->override_primary_lut = cpu_to_le32(BT_COEX_INVALID_LUT);
572 bt_cmd->override_secondary_lut = cpu_to_le32(BT_COEX_INVALID_LUT);
573
574 mode = iwlwifi_mod_params.bt_coex_active ? BT_COEX_NW : BT_COEX_DISABLE;
575 bt_cmd->mode = cpu_to_le32(mode);
dac94da8 576
741e703b 577 if (IWL_MVM_BT_COEX_SYNC2SCO)
430a3bba
EG		 578 bt_cmd->enabled_modules |=
579 cpu_to_le32(BT_COEX_SYNC2SCO_ENABLED);
741e703b 580
430a3bba
EG		 581 if (IWL_MVM_BT_COEX_CORUNNING)
582 bt_cmd->enabled_modules |= cpu_to_le32(BT_COEX_CORUN_ENABLED);
b9fae2d5 583
cdb00563 584 if (IWL_MVM_BT_COEX_MPLUT) {
430a3bba
EG		 585 bt_cmd->enabled_modules |= cpu_to_le32(BT_COEX_MPLUT_ENABLED);
586 bt_cmd->enabled_modules |=
587 cpu_to_le32(BT_COEX_MPLUT_BOOST_ENABLED);
cdb00563
EG		 588 }
589
261c0ec0
EG		 590 bt_cmd->enabled_modules |= cpu_to_le32(BT_COEX_HIGH_BAND_RET);
591
d1d5e3cd
EG		 592 if (mvm->cfg->bt_shared_single_ant)
593 memcpy(&bt_cmd->decision_lut, iwl_single_shared_ant,
594 sizeof(iwl_single_shared_ant));
595 else
596 memcpy(&bt_cmd->decision_lut, iwl_combined_lookup,
597 sizeof(iwl_combined_lookup));
598
430a3bba 599 memcpy(&bt_cmd->mplut_prio_boost, iwl_bt_prio_boost,
dac94da8 600 sizeof(iwl_bt_prio_boost));
430a3bba 601 memcpy(&bt_cmd->multiprio_lut, iwl_bt_mprio_lut,
dac94da8 602 sizeof(iwl_bt_mprio_lut));
931d4160 603
a39979a8 604send_cmd:
2b76ef13 605 memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
dac94da8 606 memset(&mvm->last_bt_ci_cmd, 0, sizeof(mvm->last_bt_ci_cmd));
2b76ef13 607
03e304e4 608 ret = iwl_mvm_send_cmd(mvm, &cmd);
931d4160 609
03e304e4
EG		 610 kfree(bt_cmd);
611 return ret;
931d4160 612}
f421f9c3 613
df878f38
EG		 614static int iwl_mvm_bt_udpate_sw_boost(struct iwl_mvm *mvm,
615 bool reduced_tx_power)
2b76ef13
EG		 616{
617 enum iwl_bt_kill_msk bt_kill_msk;
df878f38 618 struct iwl_bt_coex_sw_boost_update_cmd cmd = {};
430a3bba 619 struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;
2b76ef13
EG		 620
621 lockdep_assert_held(&mvm->mutex);
622
623 if (reduced_tx_power) {
624 /* Reduced Tx power has precedence on the type of the profile */
625 bt_kill_msk = BT_KILL_MSK_REDUCED_TXPOW;
626 } else {
627 /* Low latency BT profile is active: give higher prio to BT */
628 if (BT_MBOX_MSG(notif, 3, SCO_STATE) ||
629 BT_MBOX_MSG(notif, 3, A2DP_STATE) ||
630 BT_MBOX_MSG(notif, 3, SNIFF_STATE))
631 bt_kill_msk = BT_KILL_MSK_SCO_HID_A2DP;
632 else
633 bt_kill_msk = BT_KILL_MSK_DEFAULT;
634 }
635
636 IWL_DEBUG_COEX(mvm,
637 "Update kill_msk: %d - SCO %sactive A2DP %sactive SNIFF %sactive\n",
638 bt_kill_msk,
639 BT_MBOX_MSG(notif, 3, SCO_STATE) ? "" : "in",
640 BT_MBOX_MSG(notif, 3, A2DP_STATE) ? "" : "in",
641 BT_MBOX_MSG(notif, 3, SNIFF_STATE) ? "" : "in");
642
643 /* Don't send HCMD if there is no update */
644 if (bt_kill_msk == mvm->bt_kill_msk)
645 return 0;
646
647 mvm->bt_kill_msk = bt_kill_msk;
03e304e4 648
df878f38
EG		 649 cmd.boost_values[0].kill_ack_msk =
650 cpu_to_le32(iwl_bt_ack_kill_msk[bt_kill_msk]);
651 cmd.boost_values[0].kill_cts_msk =
652 cpu_to_le32(iwl_bt_cts_kill_msk[bt_kill_msk]);
03e304e4 653
df878f38
EG		 654 cmd.boost_values[1].kill_ack_msk = cmd.boost_values[0].kill_ack_msk;
655 cmd.boost_values[2].kill_cts_msk = cmd.boost_values[0].kill_cts_msk;
656 cmd.boost_values[1].kill_ack_msk = cmd.boost_values[0].kill_ack_msk;
657 cmd.boost_values[2].kill_cts_msk = cmd.boost_values[0].kill_cts_msk;
2b76ef13 658
dac94da8
EG		 659 IWL_DEBUG_COEX(mvm, "ACK Kill msk = 0x%08x, CTS Kill msk = 0x%08x\n",
660 iwl_bt_ack_kill_msk[bt_kill_msk],
661 iwl_bt_cts_kill_msk[bt_kill_msk]);
03e304e4 662
df878f38
EG		 663 return iwl_mvm_send_cmd_pdu(mvm, BT_COEX_UPDATE_SW_BOOST, 0,
664 sizeof(cmd), &cmd);
2b76ef13
EG		 665}
666
1fa477c6
EG		 667static int iwl_mvm_bt_coex_reduced_txp(struct iwl_mvm *mvm, u8 sta_id,
668 bool enable)
2b76ef13 669{
455e7ac5 670 struct iwl_bt_coex_reduced_txp_update_cmd cmd = {};
2b76ef13 671 struct iwl_mvm_sta *mvmsta;
455e7ac5 672 u32 value;
03e304e4 673 int ret;
2b76ef13 674
f327b04c
EG		 675 mvmsta = iwl_mvm_sta_from_staid_protected(mvm, sta_id);
676 if (!mvmsta)
2b76ef13
EG		 677 return 0;
678
2b76ef13 679 /* nothing to do */
1fa477c6 680 if (mvmsta->bt_reduced_txpower == enable)
2b76ef13
EG		 681 return 0;
682
455e7ac5 683 value = mvmsta->sta_id;
03e304e4 684
2b76ef13 685 if (enable)
455e7ac5 686 value |= BT_REDUCED_TX_POWER_BIT;
2b76ef13
EG		 687
688 IWL_DEBUG_COEX(mvm, "%sable reduced Tx Power for sta %d\n",
689 enable ? "en" : "dis", sta_id);
690
455e7ac5 691 cmd.reduced_txp = cpu_to_le32(value);
2b76ef13
EG		 692 mvmsta->bt_reduced_txpower = enable;
693
455e7ac5
EG		 694 ret = iwl_mvm_send_cmd_pdu(mvm, BT_COEX_UPDATE_REDUCED_TXP, CMD_ASYNC,
695 sizeof(cmd), &cmd);
03e304e4 696
03e304e4 697 return ret;
2b76ef13
EG		 698}
699
700struct iwl_bt_iterator_data {
430a3bba 701 struct iwl_bt_coex_profile_notif *notif;
2b76ef13
EG		 702 struct iwl_mvm *mvm;
703 u32 num_bss_ifaces;
9e511c31 704 bool reduced_tx_power;
dac94da8
EG		 705 struct ieee80211_chanctx_conf *primary;
706 struct ieee80211_chanctx_conf *secondary;
0ee5bcdd 707 bool primary_ll;
7da052b8
EG		 708};
709
f6fc5775
EG		 710static inline
711void iwl_mvm_bt_coex_enable_rssi_event(struct iwl_mvm *mvm,
712 struct ieee80211_vif *vif,
713 bool enable, int rssi)
714{
715 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
716
717 mvmvif->bf_data.last_bt_coex_event = rssi;
718 mvmvif->bf_data.bt_coex_max_thold =
8286d9f5 719 enable ? -IWL_MVM_BT_COEX_EN_RED_TXP_THRESH : 0;
f6fc5775 720 mvmvif->bf_data.bt_coex_min_thold =
8286d9f5 721 enable ? -IWL_MVM_BT_COEX_DIS_RED_TXP_THRESH : 0;
f6fc5775
EG		 722}
723
dac94da8 724/* must be called under rcu_read_lock */
7da052b8
EG		 725static void iwl_mvm_bt_notif_iterator(void *_data, u8 *mac,
726 struct ieee80211_vif *vif)
727{
728 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2b76ef13
EG		 729 struct iwl_bt_iterator_data *data = _data;
730 struct iwl_mvm *mvm = data->mvm;
7da052b8
EG		 731 struct ieee80211_chanctx_conf *chanctx_conf;
732 enum ieee80211_smps_mode smps_mode;
f6415f6b 733 u32 bt_activity_grading;
2b76ef13 734 int ave_rssi;
7da052b8 735
9ee718aa 736 lockdep_assert_held(&mvm->mutex);
7da052b8 737
f6415f6b
EG		 738 switch (vif->type) {
739 case NL80211_IFTYPE_STATION:
4d66449a
EG		 740 /* Count BSSes vifs */
741 data->num_bss_ifaces++;
f6415f6b
EG		 742 /* default smps_mode for BSS / P2P client is AUTOMATIC */
743 smps_mode = IEEE80211_SMPS_AUTOMATIC;
f6415f6b
EG		 744 break;
745 case NL80211_IFTYPE_AP:
746 /* default smps_mode for AP / GO is OFF */
747 smps_mode = IEEE80211_SMPS_OFF;
748 if (!mvmvif->ap_ibss_active) {
749 iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX,
750 smps_mode);
751 return;
752 }
7da052b8 753
f6415f6b
EG		 754 /* the Ack / Cts kill mask must be default if AP / GO */
755 data->reduced_tx_power = false;
756 break;
757 default:
758 return;
759 }
7da052b8 760
dac94da8
EG		 761 chanctx_conf = rcu_dereference(vif->chanctx_conf);
762
763 /* If channel context is invalid or not on 2.4GHz .. */
764 if ((!chanctx_conf ||
765 chanctx_conf->def.chan->band != IEEE80211_BAND_2GHZ)) {
f6415f6b
EG		 766 /* ... relax constraints and disable rssi events */
767 iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX,
768 smps_mode);
4d66449a 769 data->reduced_tx_power = false;
0f618e6e
EG		 770 if (vif->type == NL80211_IFTYPE_STATION) {
771 iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id,
772 false);
f6415f6b 773 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, false, 0);
0f618e6e 774 }
41069b46 775 return;
dac94da8
EG		 776 }
777
f6415f6b
EG		 778 bt_activity_grading = le32_to_cpu(data->notif->bt_activity_grading);
779 if (bt_activity_grading >= BT_HIGH_TRAFFIC)
780 smps_mode = IEEE80211_SMPS_STATIC;
781 else if (bt_activity_grading >= BT_LOW_TRAFFIC)
782 smps_mode = vif->type == NL80211_IFTYPE_AP ?
783 IEEE80211_SMPS_OFF :
784 IEEE80211_SMPS_DYNAMIC;
4d66449a
EG		 785
786 /* relax SMPS contraints for next association */
787 if (!vif->bss_conf.assoc)
788 smps_mode = IEEE80211_SMPS_AUTOMATIC;
789
4c86f938
EG		 790 if (IWL_COEX_IS_RRC_ON(mvm->last_bt_notif.ttc_rrc_status,
791 mvmvif->phy_ctxt->id))
792 smps_mode = IEEE80211_SMPS_AUTOMATIC;
793
f6415f6b 794 IWL_DEBUG_COEX(data->mvm,
430a3bba
EG		 795 "mac %d: bt_activity_grading %d smps_req %d\n",
796 mvmvif->id, bt_activity_grading, smps_mode);
f6415f6b
EG		 797
798 iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX, smps_mode);
799
0ee5bcdd
EG		 800 /* low latency is always primary */
801 if (iwl_mvm_vif_low_latency(mvmvif)) {
802 data->primary_ll = true;
803
804 data->secondary = data->primary;
805 data->primary = chanctx_conf;
806 }
807
dac94da8 808 if (vif->type == NL80211_IFTYPE_AP) {
5023d966 809 if (!mvmvif->ap_ibss_active)
dac94da8
EG		 810 return;
811
dac94da8
EG		 812 if (chanctx_conf == data->primary)
813 return;
814
0ee5bcdd
EG		 815 if (!data->primary_ll) {
816 /*
817 * downgrade the current primary no matter what its
818 * type is.
819 */
820 data->secondary = data->primary;
821 data->primary = chanctx_conf;
822 } else {
823 /* there is low latency vif - we will be secondary */
824 data->secondary = chanctx_conf;
825 }
9166b1ee
EG		 826 return;
827 }
828
0ee5bcdd
EG		 829 /*
830 * STA / P2P Client, try to be primary if first vif. If we are in low
831 * latency mode, we are already in primary and just don't do much
832 */
dac94da8
EG		 833 if (!data->primary || data->primary == chanctx_conf)
834 data->primary = chanctx_conf;
835 else if (!data->secondary)
836 /* if secondary is not NULL, it might be a GO */
837 data->secondary = chanctx_conf;
838
4d66449a
EG		 839 /*
840 * don't reduce the Tx power if one of these is true:
841 * we are in LOOSE
842 * single share antenna product
843 * BT is active
844 * we are associated
845 */
39149911 846 if (iwl_get_coex_type(mvm, vif) == BT_COEX_LOOSE_LUT ||
4d66449a 847 mvm->cfg->bt_shared_single_ant || !vif->bss_conf.assoc ||
430a3bba 848 le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) == BT_OFF) {
39149911 849 data->reduced_tx_power = false;
0f618e6e 850 iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false);
f6fc5775 851 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, false, 0);
2b76ef13 852 return;
39149911 853 }
2b76ef13 854
911222b5
AO		 855 /* try to get the avg rssi from fw */
856 ave_rssi = mvmvif->bf_data.ave_beacon_signal;
2b76ef13
EG		 857
858 /* if the RSSI isn't valid, fake it is very low */
859 if (!ave_rssi)
860 ave_rssi = -100;
8286d9f5 861 if (ave_rssi > -IWL_MVM_BT_COEX_EN_RED_TXP_THRESH) {
2b76ef13
EG		 862 if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true))
863 IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
864
865 /*
866 * bt_kill_msk can be BT_KILL_MSK_REDUCED_TXPOW only if all the
867 * BSS / P2P clients have rssi above threshold.
868 * We set the bt_kill_msk to BT_KILL_MSK_REDUCED_TXPOW before
869 * the iteration, if one interface's rssi isn't good enough,
870 * bt_kill_msk will be set to default values.
871 */
8286d9f5 872 } else if (ave_rssi < -IWL_MVM_BT_COEX_DIS_RED_TXP_THRESH) {
2b76ef13
EG		 873 if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
874 IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
875
876 /*
877 * One interface hasn't rssi above threshold, bt_kill_msk must
878 * be set to default values.
879 */
9e511c31 880 data->reduced_tx_power = false;
2b76ef13
EG		 881 }
882
883 /* Begin to monitor the RSSI: it may influence the reduced Tx power */
f6fc5775 884 iwl_mvm_bt_coex_enable_rssi_event(mvm, vif, true, ave_rssi);
7da052b8
EG		 885}
886
d37cac98 887static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm *mvm)
f421f9c3 888{
2b76ef13 889 struct iwl_bt_iterator_data data = {
7da052b8 890 .mvm = mvm,
d37cac98 891 .notif = &mvm->last_bt_notif,
9e511c31 892 .reduced_tx_power = true,
7da052b8 893 };
430a3bba 894 struct iwl_bt_coex_ci_cmd cmd = {};
dac94da8 895 u8 ci_bw_idx;
f421f9c3 896
a39979a8
EG		 897 /* Ignore updates if we are in force mode */
898 if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
899 return;
900
dac94da8 901 rcu_read_lock();
7da052b8
EG		 902 ieee80211_iterate_active_interfaces_atomic(
903 mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
904 iwl_mvm_bt_notif_iterator, &data);
905
dac94da8
EG		 906 if (data.primary) {
907 struct ieee80211_chanctx_conf *chan = data.primary;
908 if (WARN_ON(!chan->def.chan)) {
909 rcu_read_unlock();
910 return;
911 }
912
913 if (chan->def.width < NL80211_CHAN_WIDTH_40) {
914 ci_bw_idx = 0;
dac94da8 915 } else {
dac94da8
EG		 916 if (chan->def.center_freq1 >
917 chan->def.chan->center_freq)
918 ci_bw_idx = 2;
919 else
920 ci_bw_idx = 1;
921 }
922
923 cmd.bt_primary_ci =
924 iwl_ci_mask[chan->def.chan->hw_value][ci_bw_idx];
430a3bba
EG		 925 cmd.primary_ch_phy_id =
926 cpu_to_le32(*((u16 *)data.primary->drv_priv));
dac94da8
EG		 927 }
928
929 if (data.secondary) {
930 struct ieee80211_chanctx_conf *chan = data.secondary;
931 if (WARN_ON(!data.secondary->def.chan)) {
932 rcu_read_unlock();
933 return;
934 }
935
936 if (chan->def.width < NL80211_CHAN_WIDTH_40) {
937 ci_bw_idx = 0;
dac94da8 938 } else {
dac94da8
EG		 939 if (chan->def.center_freq1 >
940 chan->def.chan->center_freq)
941 ci_bw_idx = 2;
942 else
943 ci_bw_idx = 1;
944 }
945
946 cmd.bt_secondary_ci =
947 iwl_ci_mask[chan->def.chan->hw_value][ci_bw_idx];
430a3bba
EG		 948 cmd.secondary_ch_phy_id =
949 cpu_to_le32(*((u16 *)data.secondary->drv_priv));
dac94da8
EG		 950 }
951
952 rcu_read_unlock();
953
954 /* Don't spam the fw with the same command over and over */
955 if (memcmp(&cmd, &mvm->last_bt_ci_cmd, sizeof(cmd))) {
a1022927 956 if (iwl_mvm_send_cmd_pdu(mvm, BT_COEX_CI, 0,
dac94da8 957 sizeof(cmd), &cmd))
3c6acb61 958 IWL_ERR(mvm, "Failed to send BT_CI cmd\n");
dac94da8
EG		 959 memcpy(&mvm->last_bt_ci_cmd, &cmd, sizeof(cmd));
960 }
961
2b76ef13
EG		 962 /*
963 * If there are no BSS / P2P client interfaces, reduced Tx Power is
964 * irrelevant since it is based on the RSSI coming from the beacon.
965 * Use BT_KILL_MSK_DEFAULT in that case.
966 */
9e511c31 967 data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
2b76ef13 968
df878f38 969 if (iwl_mvm_bt_udpate_sw_boost(mvm, data.reduced_tx_power))
2b76ef13 970 IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
9166b1ee
EG		 971}
972
9166b1ee
EG		 973int iwl_mvm_rx_bt_coex_notif(struct iwl_mvm *mvm,
974 struct iwl_rx_cmd_buffer *rxb,
975 struct iwl_device_cmd *dev_cmd)
976{
977 struct iwl_rx_packet *pkt = rxb_addr(rxb);
df878f38 978 struct iwl_bt_coex_profile_notif *notif = (void *)pkt->data;
9166b1ee 979
0ea8d043
EG		 980 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
981 return iwl_mvm_rx_bt_coex_notif_old(mvm, rxb, dev_cmd);
982
9166b1ee 983 IWL_DEBUG_COEX(mvm, "BT Coex Notification received\n");
dac94da8
EG		 984 IWL_DEBUG_COEX(mvm, "\tBT ci compliance %d\n", notif->bt_ci_compliance);
985 IWL_DEBUG_COEX(mvm, "\tBT primary_ch_lut %d\n",
986 le32_to_cpu(notif->primary_ch_lut));
987 IWL_DEBUG_COEX(mvm, "\tBT secondary_ch_lut %d\n",
988 le32_to_cpu(notif->secondary_ch_lut));
989 IWL_DEBUG_COEX(mvm, "\tBT activity grading %d\n",
990 le32_to_cpu(notif->bt_activity_grading));
9166b1ee 991
d37cac98
EG		 992 /* remember this notification for future use: rssi fluctuations */
993 memcpy(&mvm->last_bt_notif, notif, sizeof(mvm->last_bt_notif));
994
995 iwl_mvm_bt_coex_notif_handle(mvm);
2b76ef13
EG		 996
997 /*
998 * This is an async handler for a notification, returning anything other
999 * than 0 doesn't make sense even if HCMD failed.
1000 */
1001 return 0;
1002}
1003
1004static void iwl_mvm_bt_rssi_iterator(void *_data, u8 *mac,
1005 struct ieee80211_vif *vif)
1006{
1007 struct iwl_mvm_vif *mvmvif = (void *)vif->drv_priv;
1008 struct iwl_bt_iterator_data *data = _data;
1009 struct iwl_mvm *mvm = data->mvm;
1010
1011 struct ieee80211_sta *sta;
1012 struct iwl_mvm_sta *mvmsta;
1013
f6fc5775
EG		 1014 struct ieee80211_chanctx_conf *chanctx_conf;
1015
1016 rcu_read_lock();
1017 chanctx_conf = rcu_dereference(vif->chanctx_conf);
1018 /* If channel context is invalid or not on 2.4GHz - don't count it */
1019 if (!chanctx_conf ||
1020 chanctx_conf->def.chan->band != IEEE80211_BAND_2GHZ) {
1021 rcu_read_unlock();
1022 return;
1023 }
1024 rcu_read_unlock();
1025
2b76ef13
EG		 1026 if (vif->type != NL80211_IFTYPE_STATION ||
1027 mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT)
1028 return;
1029
1030 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id],
1031 lockdep_is_held(&mvm->mutex));
56c07a9c
EG		 1032
1033 /* This can happen if the station has been removed right now */
1034 if (IS_ERR_OR_NULL(sta))
1035 return;
1036
5b577a90 1037 mvmsta = iwl_mvm_sta_from_mac80211(sta);
2b76ef13 1038
8e0366f9
EG		 1039 data->num_bss_ifaces++;
1040
2b76ef13
EG		 1041 /*
1042 * This interface doesn't support reduced Tx power (because of low
1043 * RSSI probably), then set bt_kill_msk to default values.
1044 */
1045 if (!mvmsta->bt_reduced_txpower)
9e511c31 1046 data->reduced_tx_power = false;
2b76ef13
EG		 1047 /* else - possibly leave it to BT_KILL_MSK_REDUCED_TXPOW */
1048}
1049
1050void iwl_mvm_bt_rssi_event(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
1051 enum ieee80211_rssi_event rssi_event)
1052{
1053 struct iwl_mvm_vif *mvmvif = (void *)vif->drv_priv;
2b76ef13
EG		 1054 struct iwl_bt_iterator_data data = {
1055 .mvm = mvm,
9e511c31 1056 .reduced_tx_power = true,
2b76ef13
EG		 1057 };
1058 int ret;
1059
0ea8d043
EG		 1060 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT)) {
1061 iwl_mvm_bt_rssi_event_old(mvm, vif, rssi_event);
1062 return;
1063 }
1064
3dd1cd2d 1065 lockdep_assert_held(&mvm->mutex);
2b76ef13 1066
a39979a8
EG		 1067 /* Ignore updates if we are in force mode */
1068 if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
1069 return;
1070
1e929199
EG		 1071 /*
1072 * Rssi update while not associated - can happen since the statistics
1073 * are handled asynchronously
1074 */
1075 if (mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT)
3dd1cd2d 1076 return;
2b76ef13 1077
4515f30f 1078 /* No BT - reports should be disabled */
430a3bba 1079 if (le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) == BT_OFF)
3dd1cd2d 1080 return;
2b76ef13
EG		 1081
1082 IWL_DEBUG_COEX(mvm, "RSSI for %pM is now %s\n", vif->bss_conf.bssid,
1083 rssi_event == RSSI_EVENT_HIGH ? "HIGH" : "LOW");
1084
1085 /*
1086 * Check if rssi is good enough for reduced Tx power, but not in loose
1087 * scheme.
1088 */
39149911 1089 if (rssi_event == RSSI_EVENT_LOW || mvm->cfg->bt_shared_single_ant ||
4515f30f 1090 iwl_get_coex_type(mvm, vif) == BT_COEX_LOOSE_LUT)
2b76ef13
EG		 1091 ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id,
1092 false);
f421f9c3 1093 else
2b76ef13 1094 ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true);
f421f9c3 1095
2b76ef13
EG		 1096 if (ret)
1097 IWL_ERR(mvm, "couldn't send BT_CONFIG HCMD upon RSSI event\n");
f421f9c3 1098
2b76ef13
EG		 1099 ieee80211_iterate_active_interfaces_atomic(
1100 mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
1101 iwl_mvm_bt_rssi_iterator, &data);
f421f9c3 1102
2b76ef13
EG		 1103 /*
1104 * If there are no BSS / P2P client interfaces, reduced Tx Power is
1105 * irrelevant since it is based on the RSSI coming from the beacon.
1106 * Use BT_KILL_MSK_DEFAULT in that case.
1107 */
9e511c31 1108 data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
f421f9c3 1109
df878f38 1110 if (iwl_mvm_bt_udpate_sw_boost(mvm, data.reduced_tx_power))
2b76ef13 1111 IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
f421f9c3 1112}
9166b1ee 1113
9145d151
EG		 1114#define LINK_QUAL_AGG_TIME_LIMIT_DEF (4000)
1115#define LINK_QUAL_AGG_TIME_LIMIT_BT_ACT (1200)
1116
5b7ff615
EG		 1117u16 iwl_mvm_coex_agg_time_limit(struct iwl_mvm *mvm,
1118 struct ieee80211_sta *sta)
9145d151 1119{
5b577a90 1120 struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
4c86f938
EG		 1121 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(mvmsta->vif);
1122 struct iwl_mvm_phy_ctxt *phy_ctxt = mvmvif->phy_ctxt;
9145d151
EG		 1123 enum iwl_bt_coex_lut_type lut_type;
1124
0ea8d043
EG		 1125 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
1126 return iwl_mvm_coex_agg_time_limit_old(mvm, sta);
1127
4c86f938
EG		 1128 if (IWL_COEX_IS_TTC_ON(mvm->last_bt_notif.ttc_rrc_status, phy_ctxt->id))
1129 return LINK_QUAL_AGG_TIME_LIMIT_DEF;
1130
9145d151 1131 if (le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) <
c2119351 1132 BT_HIGH_TRAFFIC)
9145d151 1133 return LINK_QUAL_AGG_TIME_LIMIT_DEF;
35fbf5d0 1134
9145d151
EG		 1135 lut_type = iwl_get_coex_type(mvm, mvmsta->vif);
1136
7fa4fa0c 1137 if (lut_type == BT_COEX_LOOSE_LUT || lut_type == BT_COEX_INVALID_LUT)
9145d151
EG		 1138 return LINK_QUAL_AGG_TIME_LIMIT_DEF;
1139
1140 /* tight coex, high bt traffic, reduce AGG time limit */
1141 return LINK_QUAL_AGG_TIME_LIMIT_BT_ACT;
1142}
1143
ffa6c707
EG		 1144bool iwl_mvm_bt_coex_is_mimo_allowed(struct iwl_mvm *mvm,
1145 struct ieee80211_sta *sta)
1146{
5b577a90 1147 struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
4c86f938
EG		 1148 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(mvmsta->vif);
1149 struct iwl_mvm_phy_ctxt *phy_ctxt = mvmvif->phy_ctxt;
7fa4fa0c 1150 enum iwl_bt_coex_lut_type lut_type;
ffa6c707 1151
0ea8d043 1152 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
5fc7d86c 1153 return iwl_mvm_bt_coex_is_mimo_allowed_old(mvm, sta);
0ea8d043 1154
4c86f938 1155 if (IWL_COEX_IS_TTC_ON(mvm->last_bt_notif.ttc_rrc_status, phy_ctxt->id))
35fbf5d0
EG		 1156 return true;
1157
ffa6c707
EG		 1158 if (le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) <
1159 BT_HIGH_TRAFFIC)
1160 return true;
1161
1162 /*
7fa4fa0c
EG		 1163 * In Tight / TxTxDis, BT can't Rx while we Tx, so use both antennas
1164 * since BT is already killed.
1165 * In Loose, BT can Rx while we Tx, so forbid MIMO to let BT Rx while
1166 * we Tx.
1167 * When we are in 5GHz, we'll get BT_COEX_INVALID_LUT allowing MIMO.
ffa6c707 1168 */
7fa4fa0c
EG		 1169 lut_type = iwl_get_coex_type(mvm, mvmsta->vif);
1170 return lut_type != BT_COEX_LOOSE_LUT;
ffa6c707
EG		 1171}
1172
34c8b24f
EG		 1173bool iwl_mvm_bt_coex_is_shared_ant_avail(struct iwl_mvm *mvm)
1174{
0ea8d043
EG		 1175 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
1176 return iwl_mvm_bt_coex_is_shared_ant_avail_old(mvm);
1177
34c8b24f
EG		 1178 return le32_to_cpu(mvm->last_bt_notif.bt_activity_grading) == BT_OFF;
1179}
1180
2fd647f8
EP		 1181bool iwl_mvm_bt_coex_is_tpc_allowed(struct iwl_mvm *mvm,
1182 enum ieee80211_band band)
1183{
1184 u32 bt_activity = le32_to_cpu(mvm->last_bt_notif.bt_activity_grading);
1185
0ea8d043
EG		 1186 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
1187 return iwl_mvm_bt_coex_is_tpc_allowed_old(mvm, band);
1188
2fd647f8
EP		 1189 if (band != IEEE80211_BAND_2GHZ)
1190 return false;
1191
1192 return bt_activity >= BT_LOW_TRAFFIC;
1193}
1194
ee7bea58 1195u8 iwl_mvm_bt_coex_tx_prio(struct iwl_mvm *mvm, struct ieee80211_hdr *hdr,
b797e3fb 1196 struct ieee80211_tx_info *info, u8 ac)
ee7bea58
EG		 1197{
1198 __le16 fc = hdr->frame_control;
1199
b797e3fb
EG		 1200 if (info->band != IEEE80211_BAND_2GHZ)
1201 return 0;
1202
cdb00563
EG		 1203 if (unlikely(mvm->bt_tx_prio))
1204 return mvm->bt_tx_prio - 1;
1205
ee7bea58 1206 /* High prio packet (wrt. BT coex) if it is EAPOL, MCAST or MGMT */
b797e3fb 1207 if (info->control.flags & IEEE80211_TX_CTRL_PORT_CTRL_PROTO ||
ee7bea58 1208 is_multicast_ether_addr(hdr->addr1) ||
b797e3fb
EG		 1209 ieee80211_is_ctl(fc) || ieee80211_is_mgmt(fc) ||
1210 ieee80211_is_nullfunc(fc) || ieee80211_is_qos_nullfunc(fc))
1211 return 3;
1212
1213 switch (ac) {
1214 case IEEE80211_AC_BE:
1215 return 1;
1216 case IEEE80211_AC_VO:
1217 return 3;
1218 case IEEE80211_AC_VI:
ee7bea58 1219 return 2;
b797e3fb
EG		 1220 default:
1221 break;
1222 }
ee7bea58
EG		 1223
1224 return 0;
1225}
1226
8e484f0b 1227void iwl_mvm_bt_coex_vif_change(struct iwl_mvm *mvm)
9166b1ee 1228{
0ea8d043
EG		 1229 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT)) {
1230 iwl_mvm_bt_coex_vif_change_old(mvm);
1231 return;
1232 }
1233
d37cac98 1234 iwl_mvm_bt_coex_notif_handle(mvm);
9166b1ee 1235}
b9fae2d5
EG		 1236
1237int iwl_mvm_rx_ant_coupling_notif(struct iwl_mvm *mvm,
1238 struct iwl_rx_cmd_buffer *rxb,
1239 struct iwl_device_cmd *dev_cmd)
1240{
1241 struct iwl_rx_packet *pkt = rxb_addr(rxb);
1242 u32 ant_isolation = le32_to_cpup((void *)pkt->data);
704602a1 1243 struct iwl_bt_coex_corun_lut_update_cmd cmd = {};
b9fae2d5
EG		 1244 u8 __maybe_unused lower_bound, upper_bound;
1245 u8 lut;
1246
0ea8d043
EG		 1247 if (!(mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_BT_COEX_SPLIT))
1248 return iwl_mvm_rx_ant_coupling_notif_old(mvm, rxb, dev_cmd);
1249
b9fae2d5
EG		 1250 if (!IWL_MVM_BT_COEX_CORUNNING)
1251 return 0;
1252
1253 lockdep_assert_held(&mvm->mutex);
1254
a39979a8
EG		 1255 /* Ignore updates if we are in force mode */
1256 if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
1257 return 0;
1258
b9fae2d5
EG		 1259 if (ant_isolation == mvm->last_ant_isol)
1260 return 0;
1261
1262 for (lut = 0; lut < ARRAY_SIZE(antenna_coupling_ranges) - 1; lut++)
1263 if (ant_isolation < antenna_coupling_ranges[lut + 1].range)
1264 break;
1265
1266 lower_bound = antenna_coupling_ranges[lut].range;
1267
1268 if (lut < ARRAY_SIZE(antenna_coupling_ranges) - 1)
1269 upper_bound = antenna_coupling_ranges[lut + 1].range;
1270 else
1271 upper_bound = antenna_coupling_ranges[lut].range;
1272
1273 IWL_DEBUG_COEX(mvm, "Antenna isolation=%d in range [%d,%d[, lut=%d\n",
1274 ant_isolation, lower_bound, upper_bound, lut);
1275
1276 mvm->last_ant_isol = ant_isolation;
1277
1278 if (mvm->last_corun_lut == lut)
1279 return 0;
1280
1281 mvm->last_corun_lut = lut;
1282
b9fae2d5 1283 /* For the moment, use the same LUT for 20GHz and 40GHz */
704602a1
EG		 1284 memcpy(&cmd.corun_lut20, antenna_coupling_ranges[lut].lut20,
1285 sizeof(cmd.corun_lut20));
b9fae2d5 1286
704602a1
EG		 1287 memcpy(&cmd.corun_lut40, antenna_coupling_ranges[lut].lut20,
1288 sizeof(cmd.corun_lut40));
b9fae2d5 1289
704602a1
EG		 1290 return iwl_mvm_send_cmd_pdu(mvm, BT_COEX_UPDATE_CORUN_LUT, 0,
1291 sizeof(cmd), &cmd);
b9fae2d5 1292}
ubuntu-bionic-kernel mirror