iwlwifi: mvm: BT Coex - allow to force the antenna allocation

This can be used for testing.

Signed-off-by: Emmanuel Grumbach <emmanuel.grumbach@intel.com>

1 files changed, 39 insertions, 0 deletions

diff --git a/drivers/net/wireless/iwlwifi/mvm/coex.c b/drivers/net/wireless/iwlwifi/mvm/coex.c
index c8c3b38228f0..b2003d82260a 100644
--- a/drivers/net/wireless/iwlwifi/mvm/coex.c
+++ b/drivers/net/wireless/iwlwifi/mvm/coex.c
@@ -106,6 +106,9 @@ static const u8 iwl_bt_prio_tbl[BT_COEX_PRIO_TBL_EVT_MAX] = {
 
 static int iwl_send_bt_prio_tbl(struct iwl_mvm *mvm)
 {
+        if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
+                return 0;
+
         return iwl_mvm_send_cmd_pdu(mvm, BT_COEX_PRIO_TABLE, 0,
                                     sizeof(struct iwl_bt_coex_prio_tbl_cmd),
                                     &iwl_bt_prio_tbl);
@@ -578,6 +581,29 @@ int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
                 return -ENOMEM;
         cmd.data[0] = bt_cmd;
 
+        lockdep_assert_held(&mvm->mutex);
+
+        if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS)) {
+                switch (mvm->bt_force_ant_mode) {
+                case BT_FORCE_ANT_AUTO:
+                        flags = BT_COEX_AUTO;
+                        break;
+                case BT_FORCE_ANT_BT:
+                        flags = BT_COEX_BT;
+                        break;
+                case BT_FORCE_ANT_WIFI:
+                        flags = BT_COEX_WIFI;
+                        break;
+                default:
+                        WARN_ON(1);
+                        flags = 0;
+                }
+
+                bt_cmd->flags = cpu_to_le32(flags);
+                bt_cmd->valid_bit_msk = cpu_to_le32(BT_VALID_ENABLE);
+                goto send_cmd;
+        }
+
         bt_cmd->max_kill = 5;
         bt_cmd->bt4_antenna_isolation_thr = BT_ANTENNA_COUPLING_THRESHOLD;
         bt_cmd->bt4_antenna_isolation = iwlwifi_mod_params.ant_coupling;
@@ -642,6 +668,7 @@ int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
         bt_cmd->kill_cts_msk =
                 cpu_to_le32(iwl_bt_cts_kill_msk[BT_KILL_MSK_DEFAULT]);
 
+send_cmd:
         memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
         memset(&mvm->last_bt_ci_cmd, 0, sizeof(mvm->last_bt_ci_cmd));
 
@@ -955,6 +982,10 @@ static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm *mvm)
         struct iwl_bt_coex_ci_cmd cmd = {};
         u8 ci_bw_idx;
 
+        /* Ignore updates if we are in force mode */
+        if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
+                return;
+
         rcu_read_lock();
         ieee80211_iterate_active_interfaces_atomic(
                                         mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
@@ -1121,6 +1152,10 @@ void iwl_mvm_bt_rssi_event(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
 
         lockdep_assert_held(&mvm->mutex);
 
+        /* Ignore updates if we are in force mode */
+        if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
+                return;
+
         /*
          * Rssi update while not associated - can happen since the statistics
          * are handled asynchronously
@@ -1274,6 +1309,10 @@ int iwl_mvm_rx_ant_coupling_notif(struct iwl_mvm *mvm,
 
         lockdep_assert_held(&mvm->mutex);
 
+        /* Ignore updates if we are in force mode */
+        if (unlikely(mvm->bt_force_ant_mode != BT_FORCE_ANT_DIS))
+                return 0;
+
         if (ant_isolation ==  mvm->last_ant_isol)
                 return 0;