1 /******************************************************************************
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.
8 * Copyright(c) 2013 - 2014 Intel Corporation. All rights reserved.
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.
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.
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,
24 * The full GNU General Public License is included in this distribution
25 * in the file called COPYING.
27 * Contact Information:
28 * Intel Linux Wireless <ilw@linux.intel.com>
29 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
33 * Copyright(c) 2013 - 2014 Intel Corporation. All rights reserved.
34 * All rights reserved.
36 * Redistribution and use in source and binary forms, with or without
37 * modification, are permitted provided that the following conditions
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
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.
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.
62 *****************************************************************************/
64 #include <net/mac80211.h>
66 #include "fw-api-bt-coex.h"
67 #include "iwl-modparams.h"
69 #include "iwl-debug.h"
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))
75 static 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),
101 #define BT_ENABLE_REDUCED_TXPOWER_THRESHOLD (-62)
102 #define BT_DISABLE_REDUCED_TXPOWER_THRESHOLD (-65)
103 #define BT_ANTENNA_COUPLING_THRESHOLD (30)
105 int iwl_send_bt_prio_tbl(struct iwl_mvm
*mvm
)
107 if (!(mvm
->fw
->ucode_capa
.flags
& IWL_UCODE_TLV_FLAGS_NEWBT_COEX
))
110 return iwl_mvm_send_cmd_pdu(mvm
, BT_COEX_PRIO_TABLE
, CMD_SYNC
,
111 sizeof(struct iwl_bt_coex_prio_tbl_cmd
),
115 const u32 iwl_bt_ack_kill_msk
[BT_KILL_MSK_MAX
] = {
116 [BT_KILL_MSK_DEFAULT
] = 0xffff0000,
117 [BT_KILL_MSK_SCO_HID_A2DP
] = 0xffffffff,
118 [BT_KILL_MSK_REDUCED_TXPOW
] = 0,
121 const u32 iwl_bt_cts_kill_msk
[BT_KILL_MSK_MAX
] = {
122 [BT_KILL_MSK_DEFAULT
] = 0xffff0000,
123 [BT_KILL_MSK_SCO_HID_A2DP
] = 0xffffffff,
124 [BT_KILL_MSK_REDUCED_TXPOW
] = 0,
127 static 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),
134 static const __le32 iwl_single_shared_ant
[BT_COEX_MAX_LUT
][BT_COEX_LUT_SIZE
] = {
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),
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),
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),
179 static const __le32 iwl_combined_lookup
[BT_COEX_MAX_LUT
][BT_COEX_LUT_SIZE
] = {
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),
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),
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),
227 /* 20MHz / 40MHz below / 40Mhz above*/
228 static 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)},
232 cpu_to_le64(0x0000001FFFULL
),
234 cpu_to_le64(0x00007FFFFFULL
),
237 cpu_to_le64(0x000000FFFFULL
),
239 cpu_to_le64(0x0003FFFFFFULL
),
242 cpu_to_le64(0x000003FFFCULL
),
244 cpu_to_le64(0x000FFFFFFCULL
),
247 cpu_to_le64(0x00001FFFE0ULL
),
249 cpu_to_le64(0x007FFFFFE0ULL
),
252 cpu_to_le64(0x00007FFF80ULL
),
253 cpu_to_le64(0x00007FFFFFULL
),
254 cpu_to_le64(0x01FFFFFF80ULL
),
257 cpu_to_le64(0x0003FFFC00ULL
),
258 cpu_to_le64(0x0003FFFFFFULL
),
259 cpu_to_le64(0x0FFFFFFC00ULL
),
262 cpu_to_le64(0x000FFFF000ULL
),
263 cpu_to_le64(0x000FFFFFFCULL
),
264 cpu_to_le64(0x3FFFFFF000ULL
),
267 cpu_to_le64(0x007FFF8000ULL
),
268 cpu_to_le64(0x007FFFFFE0ULL
),
269 cpu_to_le64(0xFFFFFF8000ULL
),
272 cpu_to_le64(0x01FFFE0000ULL
),
273 cpu_to_le64(0x01FFFFFF80ULL
),
274 cpu_to_le64(0xFFFFFE0000ULL
),
277 cpu_to_le64(0x0FFFF00000ULL
),
278 cpu_to_le64(0x0FFFFFFC00ULL
),
282 cpu_to_le64(0x3FFFC00000ULL
),
283 cpu_to_le64(0x3FFFFFF000ULL
),
287 cpu_to_le64(0xFFFE000000ULL
),
288 cpu_to_le64(0xFFFFFF8000ULL
),
292 cpu_to_le64(0xFFF8000000ULL
),
293 cpu_to_le64(0xFFFFFE0000ULL
),
297 cpu_to_le64(0xFFC0000000ULL
),
303 static const __le32 iwl_bt_mprio_lut
[BT_COEX_MULTI_PRIO_LUT_SIZE
] = {
304 cpu_to_le32(0x22002200),
305 cpu_to_le32(0x33113311),
308 static enum iwl_bt_coex_lut_type
309 iwl_get_coex_type(struct iwl_mvm
*mvm
, const struct ieee80211_vif
*vif
)
311 struct ieee80211_chanctx_conf
*chanctx_conf
;
312 enum iwl_bt_coex_lut_type ret
;
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
325 chanctx_conf
= rcu_dereference(vif
->chanctx_conf
);
328 chanctx_conf
->def
.chan
->band
!= IEEE80211_BAND_2GHZ
) {
330 return BT_COEX_LOOSE_LUT
;
333 ret
= BT_COEX_TX_DIS_LUT
;
335 if (mvm
->cfg
->bt_shared_single_ant
) {
340 phy_ctx_id
= *((u16
*)chanctx_conf
->drv_priv
);
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 */
353 int iwl_send_bt_init_conf(struct iwl_mvm
*mvm
)
355 struct iwl_bt_coex_cmd
*bt_cmd
;
356 struct iwl_host_cmd cmd
= {
358 .len
= { sizeof(*bt_cmd
), },
359 .dataflags
= { IWL_HCMD_DFL_NOCOPY
, },
365 if (!(mvm
->fw
->ucode_capa
.flags
& IWL_UCODE_TLV_FLAGS_NEWBT_COEX
))
368 bt_cmd
= kzalloc(sizeof(*bt_cmd
), GFP_KERNEL
);
371 cmd
.data
[0] = bt_cmd
;
373 bt_cmd
->max_kill
= 5;
374 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,
379 flags
= iwlwifi_mod_params
.bt_coex_active
?
380 BT_COEX_NW
: BT_COEX_DISABLE
;
381 flags
|= BT_CH_PRIMARY_EN
| BT_CH_SECONDARY_EN
| BT_SYNC_2_BT_DISABLE
;
382 bt_cmd
->flags
= cpu_to_le32(flags
);
384 bt_cmd
->valid_bit_msk
= cpu_to_le32(BT_VALID_ENABLE
|
385 BT_VALID_BT_PRIO_BOOST
|
390 BT_VALID_REDUCED_TX_POWER
|
392 BT_VALID_WIFI_RX_SW_PRIO_BOOST
|
393 BT_VALID_WIFI_TX_SW_PRIO_BOOST
|
394 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
|
399 BT_VALID_TXRX_MAX_FREQ_0
|
400 BT_VALID_SYNC_TO_SCO
);
402 if (mvm
->cfg
->bt_shared_single_ant
)
403 memcpy(&bt_cmd
->decision_lut
, iwl_single_shared_ant
,
404 sizeof(iwl_single_shared_ant
));
406 memcpy(&bt_cmd
->decision_lut
, iwl_combined_lookup
,
407 sizeof(iwl_combined_lookup
));
409 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
));
413 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
]);
418 memset(&mvm
->last_bt_notif
, 0, sizeof(mvm
->last_bt_notif
));
419 memset(&mvm
->last_bt_ci_cmd
, 0, sizeof(mvm
->last_bt_ci_cmd
));
421 ret
= iwl_mvm_send_cmd(mvm
, &cmd
);
427 static int iwl_mvm_bt_udpate_ctrl_kill_msk(struct iwl_mvm
*mvm
,
428 bool reduced_tx_power
)
430 enum iwl_bt_kill_msk bt_kill_msk
;
431 struct iwl_bt_coex_cmd
*bt_cmd
;
432 struct iwl_bt_coex_profile_notif
*notif
= &mvm
->last_bt_notif
;
433 struct iwl_host_cmd cmd
= {
436 .len
= { sizeof(*bt_cmd
), },
437 .dataflags
= { IWL_HCMD_DFL_NOCOPY
, },
442 lockdep_assert_held(&mvm
->mutex
);
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
;
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
;
454 bt_kill_msk
= BT_KILL_MSK_DEFAULT
;
458 "Update kill_msk: %d - SCO %sactive A2DP %sactive SNIFF %sactive\n",
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");
464 /* Don't send HCMD if there is no update */
465 if (bt_kill_msk
== mvm
->bt_kill_msk
)
468 mvm
->bt_kill_msk
= bt_kill_msk
;
470 bt_cmd
= kzalloc(sizeof(*bt_cmd
), GFP_KERNEL
);
473 cmd
.data
[0] = bt_cmd
;
474 bt_cmd
->flags
= cpu_to_le32(BT_COEX_NW
);
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
]);
478 bt_cmd
->valid_bit_msk
|= cpu_to_le32(BT_VALID_ENABLE
|
482 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
]);
486 ret
= iwl_mvm_send_cmd(mvm
, &cmd
);
492 static int iwl_mvm_bt_coex_reduced_txp(struct iwl_mvm
*mvm
, u8 sta_id
,
495 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
= {
499 .len
= { sizeof(*bt_cmd
), },
500 .dataflags
= { IWL_HCMD_DFL_DUP
, },
503 struct iwl_mvm_sta
*mvmsta
;
506 mvmsta
= iwl_mvm_sta_from_staid_protected(mvm
, sta_id
);
511 if (mvmsta
->bt_reduced_txpower
== enable
)
514 bt_cmd
= kzalloc(sizeof(*bt_cmd
), GFP_ATOMIC
);
517 cmd
.data
[0] = bt_cmd
;
518 bt_cmd
->flags
= cpu_to_le32(BT_COEX_NW
);
520 bt_cmd
->valid_bit_msk
=
521 cpu_to_le32(BT_VALID_ENABLE
| BT_VALID_REDUCED_TX_POWER
);
522 bt_cmd
->bt_reduced_tx_power
= sta_id
;
525 bt_cmd
->bt_reduced_tx_power
|= BT_REDUCED_TX_POWER_BIT
;
527 IWL_DEBUG_COEX(mvm
, "%sable reduced Tx Power for sta %d\n",
528 enable
? "en" : "dis", sta_id
);
530 mvmsta
->bt_reduced_txpower
= enable
;
532 ret
= iwl_mvm_send_cmd(mvm
, &cmd
);
538 struct iwl_bt_iterator_data
{
539 struct iwl_bt_coex_profile_notif
*notif
;
542 bool reduced_tx_power
;
543 struct ieee80211_chanctx_conf
*primary
;
544 struct ieee80211_chanctx_conf
*secondary
;
548 void iwl_mvm_bt_coex_enable_rssi_event(struct iwl_mvm
*mvm
,
549 struct ieee80211_vif
*vif
,
550 bool enable
, int rssi
)
552 struct iwl_mvm_vif
*mvmvif
= iwl_mvm_vif_from_mac80211(vif
);
554 mvmvif
->bf_data
.last_bt_coex_event
= rssi
;
555 mvmvif
->bf_data
.bt_coex_max_thold
=
556 enable
? BT_ENABLE_REDUCED_TXPOWER_THRESHOLD
: 0;
557 mvmvif
->bf_data
.bt_coex_min_thold
=
558 enable
? BT_DISABLE_REDUCED_TXPOWER_THRESHOLD
: 0;
561 /* must be called under rcu_read_lock */
562 static void iwl_mvm_bt_notif_iterator(void *_data
, u8
*mac
,
563 struct ieee80211_vif
*vif
)
565 struct iwl_mvm_vif
*mvmvif
= iwl_mvm_vif_from_mac80211(vif
);
566 struct iwl_bt_iterator_data
*data
= _data
;
567 struct iwl_mvm
*mvm
= data
->mvm
;
568 struct ieee80211_chanctx_conf
*chanctx_conf
;
569 enum ieee80211_smps_mode smps_mode
;
572 lockdep_assert_held(&mvm
->mutex
);
574 if (vif
->type
!= NL80211_IFTYPE_STATION
&&
575 vif
->type
!= NL80211_IFTYPE_AP
)
578 smps_mode
= IEEE80211_SMPS_AUTOMATIC
;
580 chanctx_conf
= rcu_dereference(vif
->chanctx_conf
);
582 /* If channel context is invalid or not on 2.4GHz .. */
583 if ((!chanctx_conf
||
584 chanctx_conf
->def
.chan
->band
!= IEEE80211_BAND_2GHZ
)) {
585 /* ... and it is an associated STATION, relax constraints */
586 if (vif
->type
== NL80211_IFTYPE_STATION
&& vif
->bss_conf
.assoc
)
587 iwl_mvm_update_smps(mvm
, vif
, IWL_MVM_SMPS_REQ_BT_COEX
,
589 iwl_mvm_bt_coex_enable_rssi_event(mvm
, vif
, false, 0);
593 /* SoftAP / GO will always be primary */
594 if (vif
->type
== NL80211_IFTYPE_AP
) {
595 if (!mvmvif
->ap_ibss_active
)
598 /* the Ack / Cts kill mask must be default if AP / GO */
599 data
->reduced_tx_power
= false;
601 if (chanctx_conf
== data
->primary
)
604 /* downgrade the current primary no matter what its type is */
605 data
->secondary
= data
->primary
;
606 data
->primary
= chanctx_conf
;
610 data
->num_bss_ifaces
++;
612 /* we are now a STA / P2P Client, and take associated ones only */
613 if (!vif
->bss_conf
.assoc
)
616 /* STA / P2P Client, try to be primary if first vif */
617 if (!data
->primary
|| data
->primary
== chanctx_conf
)
618 data
->primary
= chanctx_conf
;
619 else if (!data
->secondary
)
620 /* if secondary is not NULL, it might be a GO */
621 data
->secondary
= chanctx_conf
;
623 if (le32_to_cpu(data
->notif
->bt_activity_grading
) >= BT_HIGH_TRAFFIC
)
624 smps_mode
= IEEE80211_SMPS_STATIC
;
625 else if (le32_to_cpu(data
->notif
->bt_activity_grading
) >=
627 smps_mode
= IEEE80211_SMPS_DYNAMIC
;
629 IWL_DEBUG_COEX(data
->mvm
,
630 "mac %d: bt_status %d bt_activity_grading %d smps_req %d\n",
631 mvmvif
->id
, data
->notif
->bt_status
,
632 data
->notif
->bt_activity_grading
, smps_mode
);
634 iwl_mvm_update_smps(mvm
, vif
, IWL_MVM_SMPS_REQ_BT_COEX
, smps_mode
);
636 /* don't reduce the Tx power if in loose scheme */
637 if (iwl_get_coex_type(mvm
, vif
) == BT_COEX_LOOSE_LUT
||
638 mvm
->cfg
->bt_shared_single_ant
) {
639 data
->reduced_tx_power
= false;
640 iwl_mvm_bt_coex_enable_rssi_event(mvm
, vif
, false, 0);
644 /* reduced Txpower only if BT is on, so ...*/
645 if (!data
->notif
->bt_status
) {
646 /* ... cancel reduced Tx power ... */
647 if (iwl_mvm_bt_coex_reduced_txp(mvm
, mvmvif
->ap_sta_id
, false))
648 IWL_ERR(mvm
, "Couldn't send BT_CONFIG cmd\n");
649 data
->reduced_tx_power
= false;
651 /* ... and there is no need to get reports on RSSI any more. */
652 iwl_mvm_bt_coex_enable_rssi_event(mvm
, vif
, false, 0);
656 /* try to get the avg rssi from fw */
657 ave_rssi
= mvmvif
->bf_data
.ave_beacon_signal
;
659 /* if the RSSI isn't valid, fake it is very low */
662 if (ave_rssi
> BT_ENABLE_REDUCED_TXPOWER_THRESHOLD
) {
663 if (iwl_mvm_bt_coex_reduced_txp(mvm
, mvmvif
->ap_sta_id
, true))
664 IWL_ERR(mvm
, "Couldn't send BT_CONFIG cmd\n");
667 * bt_kill_msk can be BT_KILL_MSK_REDUCED_TXPOW only if all the
668 * BSS / P2P clients have rssi above threshold.
669 * We set the bt_kill_msk to BT_KILL_MSK_REDUCED_TXPOW before
670 * the iteration, if one interface's rssi isn't good enough,
671 * bt_kill_msk will be set to default values.
673 } else if (ave_rssi
< BT_DISABLE_REDUCED_TXPOWER_THRESHOLD
) {
674 if (iwl_mvm_bt_coex_reduced_txp(mvm
, mvmvif
->ap_sta_id
, false))
675 IWL_ERR(mvm
, "Couldn't send BT_CONFIG cmd\n");
678 * One interface hasn't rssi above threshold, bt_kill_msk must
679 * be set to default values.
681 data
->reduced_tx_power
= false;
684 /* Begin to monitor the RSSI: it may influence the reduced Tx power */
685 iwl_mvm_bt_coex_enable_rssi_event(mvm
, vif
, true, ave_rssi
);
688 static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm
*mvm
)
690 struct iwl_bt_iterator_data data
= {
692 .notif
= &mvm
->last_bt_notif
,
693 .reduced_tx_power
= true,
695 struct iwl_bt_coex_ci_cmd cmd
= {};
699 ieee80211_iterate_active_interfaces_atomic(
700 mvm
->hw
, IEEE80211_IFACE_ITER_NORMAL
,
701 iwl_mvm_bt_notif_iterator
, &data
);
704 struct ieee80211_chanctx_conf
*chan
= data
.primary
;
705 if (WARN_ON(!chan
->def
.chan
)) {
710 if (chan
->def
.width
< NL80211_CHAN_WIDTH_40
) {
712 cmd
.co_run_bw_primary
= 0;
714 cmd
.co_run_bw_primary
= 1;
715 if (chan
->def
.center_freq1
>
716 chan
->def
.chan
->center_freq
)
723 iwl_ci_mask
[chan
->def
.chan
->hw_value
][ci_bw_idx
];
724 cmd
.primary_ch_phy_id
= *((u16
*)data
.primary
->drv_priv
);
727 if (data
.secondary
) {
728 struct ieee80211_chanctx_conf
*chan
= data
.secondary
;
729 if (WARN_ON(!data
.secondary
->def
.chan
)) {
734 if (chan
->def
.width
< NL80211_CHAN_WIDTH_40
) {
736 cmd
.co_run_bw_secondary
= 0;
738 cmd
.co_run_bw_secondary
= 1;
739 if (chan
->def
.center_freq1
>
740 chan
->def
.chan
->center_freq
)
746 cmd
.bt_secondary_ci
=
747 iwl_ci_mask
[chan
->def
.chan
->hw_value
][ci_bw_idx
];
748 cmd
.secondary_ch_phy_id
= *((u16
*)data
.secondary
->drv_priv
);
753 /* Don't spam the fw with the same command over and over */
754 if (memcmp(&cmd
, &mvm
->last_bt_ci_cmd
, sizeof(cmd
))) {
755 if (iwl_mvm_send_cmd_pdu(mvm
, BT_COEX_CI
, CMD_SYNC
,
757 IWL_ERR(mvm
, "Failed to send BT_CI cmd");
758 memcpy(&mvm
->last_bt_ci_cmd
, &cmd
, sizeof(cmd
));
762 * If there are no BSS / P2P client interfaces, reduced Tx Power is
763 * irrelevant since it is based on the RSSI coming from the beacon.
764 * Use BT_KILL_MSK_DEFAULT in that case.
766 data
.reduced_tx_power
= data
.reduced_tx_power
&& data
.num_bss_ifaces
;
768 if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm
, data
.reduced_tx_power
))
769 IWL_ERR(mvm
, "Failed to update the ctrl_kill_msk\n");
772 /* upon association, the fw will send in BT Coex notification */
773 int iwl_mvm_rx_bt_coex_notif(struct iwl_mvm
*mvm
,
774 struct iwl_rx_cmd_buffer
*rxb
,
775 struct iwl_device_cmd
*dev_cmd
)
777 struct iwl_rx_packet
*pkt
= rxb_addr(rxb
);
778 struct iwl_bt_coex_profile_notif
*notif
= (void *)pkt
->data
;
781 IWL_DEBUG_COEX(mvm
, "BT Coex Notification received\n");
782 IWL_DEBUG_COEX(mvm
, "\tBT status: %s\n",
783 notif
->bt_status
? "ON" : "OFF");
784 IWL_DEBUG_COEX(mvm
, "\tBT open conn %d\n", notif
->bt_open_conn
);
785 IWL_DEBUG_COEX(mvm
, "\tBT ci compliance %d\n", notif
->bt_ci_compliance
);
786 IWL_DEBUG_COEX(mvm
, "\tBT primary_ch_lut %d\n",
787 le32_to_cpu(notif
->primary_ch_lut
));
788 IWL_DEBUG_COEX(mvm
, "\tBT secondary_ch_lut %d\n",
789 le32_to_cpu(notif
->secondary_ch_lut
));
790 IWL_DEBUG_COEX(mvm
, "\tBT activity grading %d\n",
791 le32_to_cpu(notif
->bt_activity_grading
));
792 IWL_DEBUG_COEX(mvm
, "\tBT agg traffic load %d\n",
793 notif
->bt_agg_traffic_load
);
795 /* remember this notification for future use: rssi fluctuations */
796 memcpy(&mvm
->last_bt_notif
, notif
, sizeof(mvm
->last_bt_notif
));
798 iwl_mvm_bt_coex_notif_handle(mvm
);
801 * This is an async handler for a notification, returning anything other
802 * than 0 doesn't make sense even if HCMD failed.
807 static void iwl_mvm_bt_rssi_iterator(void *_data
, u8
*mac
,
808 struct ieee80211_vif
*vif
)
810 struct iwl_mvm_vif
*mvmvif
= (void *)vif
->drv_priv
;
811 struct iwl_bt_iterator_data
*data
= _data
;
812 struct iwl_mvm
*mvm
= data
->mvm
;
814 struct ieee80211_sta
*sta
;
815 struct iwl_mvm_sta
*mvmsta
;
817 struct ieee80211_chanctx_conf
*chanctx_conf
;
820 chanctx_conf
= rcu_dereference(vif
->chanctx_conf
);
821 /* If channel context is invalid or not on 2.4GHz - don't count it */
823 chanctx_conf
->def
.chan
->band
!= IEEE80211_BAND_2GHZ
) {
829 if (vif
->type
!= NL80211_IFTYPE_STATION
||
830 mvmvif
->ap_sta_id
== IWL_MVM_STATION_COUNT
)
833 sta
= rcu_dereference_protected(mvm
->fw_id_to_mac_id
[mvmvif
->ap_sta_id
],
834 lockdep_is_held(&mvm
->mutex
));
836 /* This can happen if the station has been removed right now */
837 if (IS_ERR_OR_NULL(sta
))
840 mvmsta
= iwl_mvm_sta_from_mac80211(sta
);
842 data
->num_bss_ifaces
++;
845 * This interface doesn't support reduced Tx power (because of low
846 * RSSI probably), then set bt_kill_msk to default values.
848 if (!mvmsta
->bt_reduced_txpower
)
849 data
->reduced_tx_power
= false;
850 /* else - possibly leave it to BT_KILL_MSK_REDUCED_TXPOW */
853 void iwl_mvm_bt_rssi_event(struct iwl_mvm
*mvm
, struct ieee80211_vif
*vif
,
854 enum ieee80211_rssi_event rssi_event
)
856 struct iwl_mvm_vif
*mvmvif
= (void *)vif
->drv_priv
;
857 struct iwl_bt_iterator_data data
= {
859 .reduced_tx_power
= true,
863 lockdep_assert_held(&mvm
->mutex
);
865 /* Rssi update while not associated ?! */
866 if (WARN_ON_ONCE(mvmvif
->ap_sta_id
== IWL_MVM_STATION_COUNT
))
869 /* No BT - reports should be disabled */
870 if (!mvm
->last_bt_notif
.bt_status
)
873 IWL_DEBUG_COEX(mvm
, "RSSI for %pM is now %s\n", vif
->bss_conf
.bssid
,
874 rssi_event
== RSSI_EVENT_HIGH
? "HIGH" : "LOW");
877 * Check if rssi is good enough for reduced Tx power, but not in loose
880 if (rssi_event
== RSSI_EVENT_LOW
|| mvm
->cfg
->bt_shared_single_ant
||
881 iwl_get_coex_type(mvm
, vif
) == BT_COEX_LOOSE_LUT
)
882 ret
= iwl_mvm_bt_coex_reduced_txp(mvm
, mvmvif
->ap_sta_id
,
885 ret
= iwl_mvm_bt_coex_reduced_txp(mvm
, mvmvif
->ap_sta_id
, true);
888 IWL_ERR(mvm
, "couldn't send BT_CONFIG HCMD upon RSSI event\n");
890 ieee80211_iterate_active_interfaces_atomic(
891 mvm
->hw
, IEEE80211_IFACE_ITER_NORMAL
,
892 iwl_mvm_bt_rssi_iterator
, &data
);
895 * If there are no BSS / P2P client interfaces, reduced Tx Power is
896 * irrelevant since it is based on the RSSI coming from the beacon.
897 * Use BT_KILL_MSK_DEFAULT in that case.
899 data
.reduced_tx_power
= data
.reduced_tx_power
&& data
.num_bss_ifaces
;
901 if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm
, data
.reduced_tx_power
))
902 IWL_ERR(mvm
, "Failed to update the ctrl_kill_msk\n");
905 #define LINK_QUAL_AGG_TIME_LIMIT_DEF (4000)
906 #define LINK_QUAL_AGG_TIME_LIMIT_BT_ACT (1200)
908 u16
iwl_mvm_bt_coex_agg_time_limit(struct iwl_mvm
*mvm
,
909 struct ieee80211_sta
*sta
)
911 struct iwl_mvm_sta
*mvmsta
= iwl_mvm_sta_from_mac80211(sta
);
912 enum iwl_bt_coex_lut_type lut_type
;
914 if (le32_to_cpu(mvm
->last_bt_notif
.bt_activity_grading
) <
916 return LINK_QUAL_AGG_TIME_LIMIT_DEF
;
918 lut_type
= iwl_get_coex_type(mvm
, mvmsta
->vif
);
920 if (lut_type
== BT_COEX_LOOSE_LUT
)
921 return LINK_QUAL_AGG_TIME_LIMIT_DEF
;
923 /* tight coex, high bt traffic, reduce AGG time limit */
924 return LINK_QUAL_AGG_TIME_LIMIT_BT_ACT
;
927 bool iwl_mvm_bt_coex_is_mimo_allowed(struct iwl_mvm
*mvm
,
928 struct ieee80211_sta
*sta
)
930 struct iwl_mvm_sta
*mvmsta
= iwl_mvm_sta_from_mac80211(sta
);
932 if (le32_to_cpu(mvm
->last_bt_notif
.bt_activity_grading
) <
937 * In Tight, BT can't Rx while we Tx, so use both antennas since BT is
939 * In Loose, BT can Rx while we Tx, so forbid MIMO to let BT Rx while we
942 return iwl_get_coex_type(mvm
, mvmsta
->vif
) == BT_COEX_TIGHT_LUT
;
945 void iwl_mvm_bt_coex_vif_change(struct iwl_mvm
*mvm
)
947 if (!(mvm
->fw
->ucode_capa
.flags
& IWL_UCODE_TLV_FLAGS_NEWBT_COEX
))
950 iwl_mvm_bt_coex_notif_handle(mvm
);