[deliverable/linux.git] / drivers / net / wireless / iwlwifi / mvm / bt-coex.c

/******************************************************************************
 *
 * This file is provided under a dual BSD/GPLv2 license.  When using or
 * redistributing this file, you may do so under either license.
 *
 * GPL LICENSE SUMMARY
 *
 * Copyright(c) 2013 Intel Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
 * USA
 *
 * The full GNU General Public License is included in this distribution
 * in the file called COPYING.
 *
 * Contact Information:
 *  Intel Linux Wireless <ilw@linux.intel.com>
 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
 *
 * BSD LICENSE
 *
 * Copyright(c) 2013 Intel Corporation. All rights reserved.
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 *  * Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 *  * Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 *  * Neither the name Intel Corporation nor the names of its
 *    contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *****************************************************************************/

#include <net/mac80211.h>

#include "fw-api-bt-coex.h"
#include "iwl-modparams.h"
#include "mvm.h"
#include "iwl-debug.h"

#define EVENT_PRIO_ANT(_evt, _prio, _shrd_ant)			\
	[(_evt)] = (((_prio) << BT_COEX_PRIO_TBL_PRIO_POS) |	\
		   ((_shrd_ant) << BT_COEX_PRIO_TBL_SHRD_ANT_POS))

static const u8 iwl_bt_prio_tbl[BT_COEX_PRIO_TBL_EVT_MAX] = {
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_INIT_CALIB1,
		       BT_COEX_PRIO_TBL_PRIO_BYPASS, 0),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_INIT_CALIB2,
		       BT_COEX_PRIO_TBL_PRIO_BYPASS, 1),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_LOW1,
		       BT_COEX_PRIO_TBL_PRIO_LOW, 0),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_LOW2,
		       BT_COEX_PRIO_TBL_PRIO_LOW, 1),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_HIGH1,
		       BT_COEX_PRIO_TBL_PRIO_HIGH, 0),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_PERIODIC_CALIB_HIGH2,
		       BT_COEX_PRIO_TBL_PRIO_HIGH, 1),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_DTIM,
		       BT_COEX_PRIO_TBL_DISABLED, 0),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_SCAN52,
		       BT_COEX_PRIO_TBL_PRIO_COEX_OFF, 0),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_SCAN24,
		       BT_COEX_PRIO_TBL_PRIO_COEX_ON, 0),
	EVENT_PRIO_ANT(BT_COEX_PRIO_TBL_EVT_IDLE,
		       BT_COEX_PRIO_TBL_PRIO_COEX_IDLE, 0),
	0, 0, 0, 0, 0, 0,
};

#undef EVENT_PRIO_ANT

/* BT Antenna Coupling Threshold (dB) */
#define IWL_BT_ANTENNA_COUPLING_THRESHOLD	(35)
#define IWL_BT_LOAD_FORCE_SISO_THRESHOLD	(3)

#define BT_ENABLE_REDUCED_TXPOWER_THRESHOLD	(-62)
#define BT_DISABLE_REDUCED_TXPOWER_THRESHOLD	(-65)
#define BT_REDUCED_TX_POWER_BIT			BIT(7)

static inline bool is_loose_coex(void)
{
	return iwlwifi_mod_params.ant_coupling >
		IWL_BT_ANTENNA_COUPLING_THRESHOLD;
}

int iwl_send_bt_prio_tbl(struct iwl_mvm *mvm)
{
	return iwl_mvm_send_cmd_pdu(mvm, BT_COEX_PRIO_TABLE, CMD_SYNC,
				    sizeof(struct iwl_bt_coex_prio_tbl_cmd),
				    &iwl_bt_prio_tbl);
}

static int iwl_send_bt_env(struct iwl_mvm *mvm, u8 action, u8 type)
{
	struct iwl_bt_coex_prot_env_cmd env_cmd;
	int ret;

	env_cmd.action = action;
	env_cmd.type = type;
	ret = iwl_mvm_send_cmd_pdu(mvm, BT_COEX_PROT_ENV, CMD_SYNC,
				   sizeof(env_cmd), &env_cmd);
	if (ret)
		IWL_ERR(mvm, "failed to send BT env command\n");
	return ret;
}

enum iwl_bt_kill_msk {
	BT_KILL_MSK_DEFAULT,
	BT_KILL_MSK_SCO_HID_A2DP,
	BT_KILL_MSK_REDUCED_TXPOW,
	BT_KILL_MSK_MAX,
};

static const u32 iwl_bt_ack_kill_msk[BT_KILL_MSK_MAX] = {
	[BT_KILL_MSK_DEFAULT] = 0xffff0000,
	[BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
	[BT_KILL_MSK_REDUCED_TXPOW] = 0,
};

static const u32 iwl_bt_cts_kill_msk[BT_KILL_MSK_MAX] = {
	[BT_KILL_MSK_DEFAULT] = 0xffff0000,
	[BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
	[BT_KILL_MSK_REDUCED_TXPOW] = 0,
};

#define IWL_BT_DEFAULT_BOOST (0xf0f0f0f0)

/* Tight Coex */
static const __le32 iwl_tight_lookup[BT_COEX_LUT_SIZE] = {
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaeaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xcc00ff28),
	cpu_to_le32(0x0000aaaa),
	cpu_to_le32(0xcc00aaaa),
	cpu_to_le32(0x0000aaaa),
	cpu_to_le32(0xc0004000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0xf0005000),
	cpu_to_le32(0xf0005000),
};

/* Loose Coex */
static const __le32 iwl_loose_lookup[BT_COEX_LUT_SIZE] = {
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaeaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xcc00ff28),
	cpu_to_le32(0x0000aaaa),
	cpu_to_le32(0xcc00aaaa),
	cpu_to_le32(0x0000aaaa),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0xf0005000),
	cpu_to_le32(0xf0005000),
};

/* Full concurrency */
static const __le32 iwl_concurrent_lookup[BT_COEX_LUT_SIZE] = {
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0xaaaaaaaa),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x00000000),
};

int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
{
	struct iwl_bt_coex_cmd cmd = {
		.max_kill = 5,
		.bt3_time_t7_value = 1,
		.bt3_prio_sample_time = 2,
		.bt3_timer_t2_value = 0xc,
	};
	int ret;

	cmd.flags = iwlwifi_mod_params.bt_coex_active ?
			BT_COEX_NW : BT_COEX_DISABLE;
	cmd.flags |= BT_CH_PRIMARY_EN | BT_SYNC_2_BT_DISABLE;

	cmd.valid_bit_msk = cpu_to_le16(BT_VALID_ENABLE |
					BT_VALID_BT_PRIO_BOOST |
					BT_VALID_MAX_KILL |
					BT_VALID_3W_TMRS |
					BT_VALID_KILL_ACK |
					BT_VALID_KILL_CTS |
					BT_VALID_REDUCED_TX_POWER |
					BT_VALID_LUT);

	if (is_loose_coex())
		memcpy(&cmd.decision_lut, iwl_loose_lookup,
		       sizeof(iwl_tight_lookup));
	else
		memcpy(&cmd.decision_lut, iwl_tight_lookup,
		       sizeof(iwl_tight_lookup));

	cmd.bt_prio_boost = cpu_to_le32(IWL_BT_DEFAULT_BOOST);
	cmd.kill_ack_msk =
		cpu_to_le32(iwl_bt_ack_kill_msk[BT_KILL_MSK_DEFAULT]);
	cmd.kill_cts_msk =
		cpu_to_le32(iwl_bt_cts_kill_msk[BT_KILL_MSK_DEFAULT]);

	memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));

	/* go to CALIB state in internal BT-Coex state machine */
	ret = iwl_send_bt_env(mvm, BT_COEX_ENV_OPEN,
			      BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
	if (ret)
		return ret;

	ret  = iwl_send_bt_env(mvm, BT_COEX_ENV_CLOSE,
			       BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
	if (ret)
		return ret;

	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_SYNC,
				    sizeof(cmd), &cmd);
}

static int iwl_mvm_bt_udpate_ctrl_kill_msk(struct iwl_mvm *mvm,
					   bool reduced_tx_power)
{
	enum iwl_bt_kill_msk bt_kill_msk;
	struct iwl_bt_coex_cmd cmd = {};
	struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;

	lockdep_assert_held(&mvm->mutex);

	if (reduced_tx_power) {
		/* Reduced Tx power has precedence on the type of the profile */
		bt_kill_msk = BT_KILL_MSK_REDUCED_TXPOW;
	} else {
		/* Low latency BT profile is active: give higher prio to BT */
		if (BT_MBOX_MSG(notif, 3, SCO_STATE)  ||
		    BT_MBOX_MSG(notif, 3, A2DP_STATE) ||
		    BT_MBOX_MSG(notif, 3, SNIFF_STATE))
			bt_kill_msk = BT_KILL_MSK_SCO_HID_A2DP;
		else
			bt_kill_msk = BT_KILL_MSK_DEFAULT;
	}

	IWL_DEBUG_COEX(mvm,
		       "Update kill_msk: %d - SCO %sactive A2DP %sactive SNIFF %sactive\n",
		       bt_kill_msk,
		       BT_MBOX_MSG(notif, 3, SCO_STATE) ? "" : "in",
		       BT_MBOX_MSG(notif, 3, A2DP_STATE) ? "" : "in",
		       BT_MBOX_MSG(notif, 3, SNIFF_STATE) ? "" : "in");

	/* Don't send HCMD if there is no update */
	if (bt_kill_msk == mvm->bt_kill_msk)
		return 0;

	mvm->bt_kill_msk = bt_kill_msk;
	cmd.kill_ack_msk = cpu_to_le32(iwl_bt_ack_kill_msk[bt_kill_msk]);
	cmd.kill_cts_msk = cpu_to_le32(iwl_bt_cts_kill_msk[bt_kill_msk]);
	cmd.valid_bit_msk = cpu_to_le16(BT_VALID_KILL_ACK | BT_VALID_KILL_CTS);

	IWL_DEBUG_COEX(mvm, "bt_kill_msk = %d\n", bt_kill_msk);
	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_SYNC,
				    sizeof(cmd), &cmd);
}

static int iwl_mvm_bt_coex_reduced_txp(struct iwl_mvm *mvm, u8 sta_id,
				       bool enable)
{
	struct iwl_bt_coex_cmd cmd = {
		.valid_bit_msk = cpu_to_le16(BT_VALID_REDUCED_TX_POWER),
		.bt_reduced_tx_power = sta_id,
	};
	struct ieee80211_sta *sta;
	struct iwl_mvm_sta *mvmsta;

	/* This can happen if the station has been removed right now */
	if (sta_id == IWL_MVM_STATION_COUNT)
		return 0;

	sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[sta_id],
					lockdep_is_held(&mvm->mutex));
	mvmsta = (void *)sta->drv_priv;

	/* nothing to do */
	if (mvmsta->bt_reduced_txpower == enable)
		return 0;

	if (enable)
		cmd.bt_reduced_tx_power |= BT_REDUCED_TX_POWER_BIT;

	IWL_DEBUG_COEX(mvm, "%sable reduced Tx Power for sta %d\n",
		       enable ? "en" : "dis", sta_id);

	mvmsta->bt_reduced_txpower = enable;

	/* Send ASYNC since this can be sent from an atomic context */
	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_ASYNC,
				    sizeof(cmd), &cmd);
}

struct iwl_bt_iterator_data {
	struct iwl_bt_coex_profile_notif *notif;
	struct iwl_mvm *mvm;
	u32 num_bss_ifaces;
	bool reduced_tx_power;
};

static void iwl_mvm_bt_notif_iterator(void *_data, u8 *mac,
				      struct ieee80211_vif *vif)
{
	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
	struct iwl_bt_iterator_data *data = _data;
	struct iwl_mvm *mvm = data->mvm;
	struct ieee80211_chanctx_conf *chanctx_conf;
	enum ieee80211_smps_mode smps_mode;
	enum ieee80211_band band;
	int ave_rssi;

	lockdep_assert_held(&mvm->mutex);
	if (vif->type != NL80211_IFTYPE_STATION)
		return;

	rcu_read_lock();
	chanctx_conf = rcu_dereference(vif->chanctx_conf);
	if (chanctx_conf && chanctx_conf->def.chan)
		band = chanctx_conf->def.chan->band;
	else
		band = -1;
	rcu_read_unlock();

	smps_mode = IEEE80211_SMPS_AUTOMATIC;

	if (band != IEEE80211_BAND_2GHZ) {
		iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX,
				    smps_mode);
		return;
	}

	if (data->notif->bt_status)
		smps_mode = IEEE80211_SMPS_DYNAMIC;

	if (data->notif->bt_traffic_load >= IWL_BT_LOAD_FORCE_SISO_THRESHOLD)
		smps_mode = IEEE80211_SMPS_STATIC;

	IWL_DEBUG_COEX(data->mvm,
		       "mac %d: bt_status %d traffic_load %d smps_req %d\n",
		       mvmvif->id,  data->notif->bt_status,
		       data->notif->bt_traffic_load, smps_mode);

	iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX, smps_mode);

	/* don't reduce the Tx power if in loose scheme */
	if (is_loose_coex())
		return;

	data->num_bss_ifaces++;

	/* reduced Txpower only if there are open BT connections, so ...*/
	if (!BT_MBOX_MSG(data->notif, 3, OPEN_CON_2)) {
		/* ... cancel reduced Tx power ... */
		if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
			IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
		data->reduced_tx_power = false;

		/* ... and there is no need to get reports on RSSI any more. */
		ieee80211_disable_rssi_reports(vif);
		return;
	}

	ave_rssi = ieee80211_ave_rssi(vif);

	/* if the RSSI isn't valid, fake it is very low */
	if (!ave_rssi)
		ave_rssi = -100;
	if (ave_rssi > BT_ENABLE_REDUCED_TXPOWER_THRESHOLD) {
		if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true))
			IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");

		/*
		 * bt_kill_msk can be BT_KILL_MSK_REDUCED_TXPOW only if all the
		 * BSS / P2P clients have rssi above threshold.
		 * We set the bt_kill_msk to BT_KILL_MSK_REDUCED_TXPOW before
		 * the iteration, if one interface's rssi isn't good enough,
		 * bt_kill_msk will be set to default values.
		 */
	} else if (ave_rssi < BT_DISABLE_REDUCED_TXPOWER_THRESHOLD) {
		if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
			IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");

		/*
		 * One interface hasn't rssi above threshold, bt_kill_msk must
		 * be set to default values.
		 */
		data->reduced_tx_power = false;
	}

	/* Begin to monitor the RSSI: it may influence the reduced Tx power */
	ieee80211_enable_rssi_reports(vif, BT_DISABLE_REDUCED_TXPOWER_THRESHOLD,
				      BT_ENABLE_REDUCED_TXPOWER_THRESHOLD);
}

static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm *mvm)
{
	struct iwl_bt_iterator_data data = {
		.mvm = mvm,
		.notif = &mvm->last_bt_notif,
		.reduced_tx_power = true,
	};

	ieee80211_iterate_active_interfaces_atomic(
					mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
					iwl_mvm_bt_notif_iterator, &data);

	/*
	 * If there are no BSS / P2P client interfaces, reduced Tx Power is
	 * irrelevant since it is based on the RSSI coming from the beacon.
	 * Use BT_KILL_MSK_DEFAULT in that case.
	 */
	data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;

	if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
		IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
}

/* upon association, the fw will send in BT Coex notification */
int iwl_mvm_rx_bt_coex_notif(struct iwl_mvm *mvm,
			     struct iwl_rx_cmd_buffer *rxb,
			     struct iwl_device_cmd *dev_cmd)
{
	struct iwl_rx_packet *pkt = rxb_addr(rxb);
	struct iwl_bt_coex_profile_notif *notif = (void *)pkt->data;


	IWL_DEBUG_COEX(mvm, "BT Coex Notification received\n");
	IWL_DEBUG_COEX(mvm, "\tBT %salive\n", notif->bt_status ? "" : "not ");
	IWL_DEBUG_COEX(mvm, "\tBT open conn %d\n", notif->bt_open_conn);
	IWL_DEBUG_COEX(mvm, "\tBT traffic load %d\n", notif->bt_traffic_load);
	IWL_DEBUG_COEX(mvm, "\tBT agg traffic load %d\n",
		       notif->bt_agg_traffic_load);
	IWL_DEBUG_COEX(mvm, "\tBT ci compliance %d\n", notif->bt_ci_compliance);

	/* remember this notification for future use: rssi fluctuations */
	memcpy(&mvm->last_bt_notif, notif, sizeof(mvm->last_bt_notif));

	iwl_mvm_bt_coex_notif_handle(mvm);

	/*
	 * This is an async handler for a notification, returning anything other
	 * than 0 doesn't make sense even if HCMD failed.
	 */
	return 0;
}

static void iwl_mvm_bt_rssi_iterator(void *_data, u8 *mac,
				   struct ieee80211_vif *vif)
{
	struct iwl_mvm_vif *mvmvif = (void *)vif->drv_priv;
	struct iwl_bt_iterator_data *data = _data;
	struct iwl_mvm *mvm = data->mvm;

	struct ieee80211_sta *sta;
	struct iwl_mvm_sta *mvmsta;

	if (vif->type != NL80211_IFTYPE_STATION ||
	    mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT)
		return;

	sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id],
					lockdep_is_held(&mvm->mutex));
	mvmsta = (void *)sta->drv_priv;

	/*
	 * This interface doesn't support reduced Tx power (because of low
	 * RSSI probably), then set bt_kill_msk to default values.
	 */
	if (!mvmsta->bt_reduced_txpower)
		data->reduced_tx_power = false;
	/* else - possibly leave it to BT_KILL_MSK_REDUCED_TXPOW */
}

void iwl_mvm_bt_rssi_event(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
			   enum ieee80211_rssi_event rssi_event)
{
	struct iwl_mvm_vif *mvmvif = (void *)vif->drv_priv;
	struct iwl_bt_iterator_data data = {
		.mvm = mvm,
		.reduced_tx_power = true,
	};
	int ret;

	mutex_lock(&mvm->mutex);

	/* Rssi update while not associated ?! */
	if (WARN_ON_ONCE(mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT))
		goto out_unlock;

	/* No open connection - reports should be disabled */
	if (!BT_MBOX_MSG(&mvm->last_bt_notif, 3, OPEN_CON_2))
		goto out_unlock;

	IWL_DEBUG_COEX(mvm, "RSSI for %pM is now %s\n", vif->bss_conf.bssid,
		       rssi_event == RSSI_EVENT_HIGH ? "HIGH" : "LOW");

	/*
	 * Check if rssi is good enough for reduced Tx power, but not in loose
	 * scheme.
	 */
	if (rssi_event == RSSI_EVENT_LOW || is_loose_coex())
		ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id,
						  false);
	else
		ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true);

	if (ret)
		IWL_ERR(mvm, "couldn't send BT_CONFIG HCMD upon RSSI event\n");

	ieee80211_iterate_active_interfaces_atomic(
		mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
		iwl_mvm_bt_rssi_iterator, &data);

	/*
	 * If there are no BSS / P2P client interfaces, reduced Tx Power is
	 * irrelevant since it is based on the RSSI coming from the beacon.
	 * Use BT_KILL_MSK_DEFAULT in that case.
	 */
	data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;

	if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
		IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");

 out_unlock:
	mutex_unlock(&mvm->mutex);
}

void iwl_mvm_bt_coex_vif_assoc(struct iwl_mvm *mvm, struct ieee80211_vif *vif)
{
	struct ieee80211_chanctx_conf *chanctx_conf;
	enum ieee80211_band band;

	rcu_read_lock();
	chanctx_conf = rcu_dereference(vif->chanctx_conf);
	if (chanctx_conf && chanctx_conf->def.chan)
		band = chanctx_conf->def.chan->band;
	else
		band = -1;
	rcu_read_unlock();

	/* if we are in 2GHz we will get a notification from the fw */
	if (band == IEEE80211_BAND_2GHZ)
		return;

	/* else, we can remove all the constraints */
	memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));

	iwl_mvm_bt_coex_notif_handle(mvm);
}
Commit	Line	Data
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	*
	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
2b76ef13 EG	64	#include <net/mac80211.h>
2b76ef13 EG	65
931d4160 EG	66	#include "fw-api-bt-coex.h"
	67	#include "iwl-modparams.h"
	68	#include "mvm.h"
f421f9c3	69	#include "iwl-debug.h"
931d4160 EG	70
	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
	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),
	96	0, 0, 0, 0, 0, 0,
	97	};
	98
	99	#undef EVENT_PRIO_ANT
	100
2b76ef13 EG	101	/* BT Antenna Coupling Threshold (dB) */
	102	#define IWL_BT_ANTENNA_COUPLING_THRESHOLD (35)
	103	#define IWL_BT_LOAD_FORCE_SISO_THRESHOLD (3)
	104
	105	#define BT_ENABLE_REDUCED_TXPOWER_THRESHOLD (-62)
	106	#define BT_DISABLE_REDUCED_TXPOWER_THRESHOLD (-65)
	107	#define BT_REDUCED_TX_POWER_BIT BIT(7)
	108
	109	static inline bool is_loose_coex(void)
	110	{
	111	return iwlwifi_mod_params.ant_coupling >
	112	IWL_BT_ANTENNA_COUPLING_THRESHOLD;
	113	}
	114
931d4160 EG	115	int iwl_send_bt_prio_tbl(struct iwl_mvm *mvm)
	116	{
	117	return iwl_mvm_send_cmd_pdu(mvm, BT_COEX_PRIO_TABLE, CMD_SYNC,
	118	sizeof(struct iwl_bt_coex_prio_tbl_cmd),
	119	&iwl_bt_prio_tbl);
	120	}
	121
	122	static int iwl_send_bt_env(struct iwl_mvm *mvm, u8 action, u8 type)
	123	{
	124	struct iwl_bt_coex_prot_env_cmd env_cmd;
	125	int ret;
	126
	127	env_cmd.action = action;
	128	env_cmd.type = type;
	129	ret = iwl_mvm_send_cmd_pdu(mvm, BT_COEX_PROT_ENV, CMD_SYNC,
	130	sizeof(env_cmd), &env_cmd);
	131	if (ret)
	132	IWL_ERR(mvm, "failed to send BT env command\n");
	133	return ret;
	134	}
	135
	136	enum iwl_bt_kill_msk {
	137	BT_KILL_MSK_DEFAULT,
	138	BT_KILL_MSK_SCO_HID_A2DP,
	139	BT_KILL_MSK_REDUCED_TXPOW,
	140	BT_KILL_MSK_MAX,
	141	};
	142
	143	static const u32 iwl_bt_ack_kill_msk[BT_KILL_MSK_MAX] = {
5b7e662b EG	144	[BT_KILL_MSK_DEFAULT] = 0xffff0000,
	145	[BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
	146	[BT_KILL_MSK_REDUCED_TXPOW] = 0,
931d4160 EG	147	};
	148
	149	static const u32 iwl_bt_cts_kill_msk[BT_KILL_MSK_MAX] = {
5b7e662b EG	150	[BT_KILL_MSK_DEFAULT] = 0xffff0000,
	151	[BT_KILL_MSK_SCO_HID_A2DP] = 0xffffffff,
	152	[BT_KILL_MSK_REDUCED_TXPOW] = 0,
931d4160 EG	153	};
	154
	155	#define IWL_BT_DEFAULT_BOOST (0xf0f0f0f0)
	156
	157	/* Tight Coex */
	158	static const __le32 iwl_tight_lookup[BT_COEX_LUT_SIZE] = {
	159	cpu_to_le32(0xaaaaaaaa),
	160	cpu_to_le32(0xaaaaaaaa),
	161	cpu_to_le32(0xaeaaaaaa),
	162	cpu_to_le32(0xaaaaaaaa),
	163	cpu_to_le32(0xcc00ff28),
	164	cpu_to_le32(0x0000aaaa),
	165	cpu_to_le32(0xcc00aaaa),
	166	cpu_to_le32(0x0000aaaa),
	167	cpu_to_le32(0xc0004000),
	168	cpu_to_le32(0x00000000),
	169	cpu_to_le32(0xf0005000),
	170	cpu_to_le32(0xf0005000),
	171	};
	172
	173	/* Loose Coex */
	174	static const __le32 iwl_loose_lookup[BT_COEX_LUT_SIZE] = {
	175	cpu_to_le32(0xaaaaaaaa),
	176	cpu_to_le32(0xaaaaaaaa),
	177	cpu_to_le32(0xaeaaaaaa),
	178	cpu_to_le32(0xaaaaaaaa),
	179	cpu_to_le32(0xcc00ff28),
	180	cpu_to_le32(0x0000aaaa),
	181	cpu_to_le32(0xcc00aaaa),
	182	cpu_to_le32(0x0000aaaa),
	183	cpu_to_le32(0x00000000),
	184	cpu_to_le32(0x00000000),
	185	cpu_to_le32(0xf0005000),
	186	cpu_to_le32(0xf0005000),
	187	};
	188
	189	/* Full concurrency */
	190	static const __le32 iwl_concurrent_lookup[BT_COEX_LUT_SIZE] = {
	191	cpu_to_le32(0xaaaaaaaa),
	192	cpu_to_le32(0xaaaaaaaa),
	193	cpu_to_le32(0xaaaaaaaa),
	194	cpu_to_le32(0xaaaaaaaa),
	195	cpu_to_le32(0xaaaaaaaa),
	196	cpu_to_le32(0xaaaaaaaa),
	197	cpu_to_le32(0xaaaaaaaa),
	198	cpu_to_le32(0xaaaaaaaa),
	199	cpu_to_le32(0x00000000),
	200	cpu_to_le32(0x00000000),
	201	cpu_to_le32(0x00000000),
	202	cpu_to_le32(0x00000000),
	203	};
	204
931d4160 EG	205	int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
	206	{
	207	struct iwl_bt_coex_cmd cmd = {
	208	.max_kill = 5,
	209	.bt3_time_t7_value = 1,
	210	.bt3_prio_sample_time = 2,
	211	.bt3_timer_t2_value = 0xc,
	212	};
	213	int ret;
	214
	215	cmd.flags = iwlwifi_mod_params.bt_coex_active ?
	216	BT_COEX_NW : BT_COEX_DISABLE;
cf69d757	217	cmd.flags \|= BT_CH_PRIMARY_EN \| BT_SYNC_2_BT_DISABLE;
931d4160 EG	218
	219	cmd.valid_bit_msk = cpu_to_le16(BT_VALID_ENABLE \|
	220	BT_VALID_BT_PRIO_BOOST \|
	221	BT_VALID_MAX_KILL \|
	222	BT_VALID_3W_TMRS \|
	223	BT_VALID_KILL_ACK \|
	224	BT_VALID_KILL_CTS \|
	225	BT_VALID_REDUCED_TX_POWER \|
	226	BT_VALID_LUT);
	227
2b76ef13	228	if (is_loose_coex())
931d4160 EG	229	memcpy(&cmd.decision_lut, iwl_loose_lookup,
	230	sizeof(iwl_tight_lookup));
	231	else
	232	memcpy(&cmd.decision_lut, iwl_tight_lookup,
	233	sizeof(iwl_tight_lookup));
	234
	235	cmd.bt_prio_boost = cpu_to_le32(IWL_BT_DEFAULT_BOOST);
	236	cmd.kill_ack_msk =
	237	cpu_to_le32(iwl_bt_ack_kill_msk[BT_KILL_MSK_DEFAULT]);
	238	cmd.kill_cts_msk =
	239	cpu_to_le32(iwl_bt_cts_kill_msk[BT_KILL_MSK_DEFAULT]);
	240
2b76ef13 EG	241	memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
2b76ef13 EG	242
931d4160 EG	243	/* go to CALIB state in internal BT-Coex state machine */
	244	ret = iwl_send_bt_env(mvm, BT_COEX_ENV_OPEN,
	245	BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
	246	if (ret)
	247	return ret;
	248
	249	ret = iwl_send_bt_env(mvm, BT_COEX_ENV_CLOSE,
	250	BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
	251	if (ret)
	252	return ret;
	253
	254	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_SYNC,
	255	sizeof(cmd), &cmd);
	256	}
f421f9c3	257
2b76ef13 EG	258	static int iwl_mvm_bt_udpate_ctrl_kill_msk(struct iwl_mvm *mvm,
	259	bool reduced_tx_power)
	260	{
	261	enum iwl_bt_kill_msk bt_kill_msk;
	262	struct iwl_bt_coex_cmd cmd = {};
	263	struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;
	264
	265	lockdep_assert_held(&mvm->mutex);
	266
	267	if (reduced_tx_power) {
	268	/* Reduced Tx power has precedence on the type of the profile */
	269	bt_kill_msk = BT_KILL_MSK_REDUCED_TXPOW;
	270	} else {
	271	/* Low latency BT profile is active: give higher prio to BT */
	272	if (BT_MBOX_MSG(notif, 3, SCO_STATE) \|\|
	273	BT_MBOX_MSG(notif, 3, A2DP_STATE) \|\|
	274	BT_MBOX_MSG(notif, 3, SNIFF_STATE))
	275	bt_kill_msk = BT_KILL_MSK_SCO_HID_A2DP;
	276	else
	277	bt_kill_msk = BT_KILL_MSK_DEFAULT;
	278	}
	279
	280	IWL_DEBUG_COEX(mvm,
	281	"Update kill_msk: %d - SCO %sactive A2DP %sactive SNIFF %sactive\n",
	282	bt_kill_msk,
	283	BT_MBOX_MSG(notif, 3, SCO_STATE) ? "" : "in",
	284	BT_MBOX_MSG(notif, 3, A2DP_STATE) ? "" : "in",
	285	BT_MBOX_MSG(notif, 3, SNIFF_STATE) ? "" : "in");
	286
	287	/* Don't send HCMD if there is no update */
	288	if (bt_kill_msk == mvm->bt_kill_msk)
	289	return 0;
	290
	291	mvm->bt_kill_msk = bt_kill_msk;
	292	cmd.kill_ack_msk = cpu_to_le32(iwl_bt_ack_kill_msk[bt_kill_msk]);
	293	cmd.kill_cts_msk = cpu_to_le32(iwl_bt_cts_kill_msk[bt_kill_msk]);
	294	cmd.valid_bit_msk = cpu_to_le16(BT_VALID_KILL_ACK \| BT_VALID_KILL_CTS);
	295
	296	IWL_DEBUG_COEX(mvm, "bt_kill_msk = %d\n", bt_kill_msk);
	297	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_SYNC,
	298	sizeof(cmd), &cmd);
	299	}
	300
	301	static int iwl_mvm_bt_coex_reduced_txp(struct iwl_mvm *mvm, u8 sta_id,
	302	bool enable)
	303	{
	304	struct iwl_bt_coex_cmd cmd = {
	305	.valid_bit_msk = cpu_to_le16(BT_VALID_REDUCED_TX_POWER),
	306	.bt_reduced_tx_power = sta_id,
	307	};
	308	struct ieee80211_sta *sta;
	309	struct iwl_mvm_sta *mvmsta;
	310
	311	/* This can happen if the station has been removed right now */
	312	if (sta_id == IWL_MVM_STATION_COUNT)
	313	return 0;
	314
	315	sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[sta_id],
	316	lockdep_is_held(&mvm->mutex));
	317	mvmsta = (void *)sta->drv_priv;
	318
	319	/* nothing to do */
	320	if (mvmsta->bt_reduced_txpower == enable)
	321	return 0;
322
323	if (enable)
324	cmd.bt_reduced_tx_power \|= BT_REDUCED_TX_POWER_BIT;
325
326	IWL_DEBUG_COEX(mvm, "%sable reduced Tx Power for sta %d\n",
327	enable ? "en" : "dis", sta_id);
328
329	mvmsta->bt_reduced_txpower = enable;
330
331	/* Send ASYNC since this can be sent from an atomic context */
332	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_ASYNC,
333	sizeof(cmd), &cmd);
334	}
335
336	struct iwl_bt_iterator_data {
7da052b8	337	struct iwl_bt_coex_profile_notif *notif;
2b76ef13 EG	338	struct iwl_mvm *mvm;
2b76ef13 EG	339	u32 num_bss_ifaces;
9e511c31	340	bool reduced_tx_power;
7da052b8 EG	341	};
	342
	343	static void iwl_mvm_bt_notif_iterator(void _data, u8 mac,
	344	struct ieee80211_vif *vif)
	345	{
	346	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2b76ef13 EG	347	struct iwl_bt_iterator_data *data = _data;
2b76ef13 EG	348	struct iwl_mvm *mvm = data->mvm;
7da052b8 EG	349	struct ieee80211_chanctx_conf *chanctx_conf;
	350	enum ieee80211_smps_mode smps_mode;
	351	enum ieee80211_band band;
2b76ef13	352	int ave_rssi;
7da052b8	353
9ee718aa	354	lockdep_assert_held(&mvm->mutex);
7da052b8 EG	355	if (vif->type != NL80211_IFTYPE_STATION)
	356	return;
	357
	358	rcu_read_lock();
	359	chanctx_conf = rcu_dereference(vif->chanctx_conf);
	360	if (chanctx_conf && chanctx_conf->def.chan)
	361	band = chanctx_conf->def.chan->band;
	362	else
	363	band = -1;
	364	rcu_read_unlock();
	365
7da052b8 EG	366	smps_mode = IEEE80211_SMPS_AUTOMATIC;
7da052b8 EG	367
9166b1ee	368	if (band != IEEE80211_BAND_2GHZ) {
9ee718aa EL	369	iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX,
9ee718aa EL	370	smps_mode);
9166b1ee EG	371	return;
	372	}
	373
7da052b8 EG	374	if (data->notif->bt_status)
	375	smps_mode = IEEE80211_SMPS_DYNAMIC;
	376
b9269262	377	if (data->notif->bt_traffic_load >= IWL_BT_LOAD_FORCE_SISO_THRESHOLD)
7da052b8 EG	378	smps_mode = IEEE80211_SMPS_STATIC;
	379
	380	IWL_DEBUG_COEX(data->mvm,
	381	"mac %d: bt_status %d traffic_load %d smps_req %d\n",
	382	mvmvif->id, data->notif->bt_status,
	383	data->notif->bt_traffic_load, smps_mode);
	384
9ee718aa	385	iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX, smps_mode);
2b76ef13 EG	386
	387	/* don't reduce the Tx power if in loose scheme */
	388	if (is_loose_coex())
	389	return;
	390
	391	data->num_bss_ifaces++;
	392
	393	/* reduced Txpower only if there are open BT connections, so ...*/
	394	if (!BT_MBOX_MSG(data->notif, 3, OPEN_CON_2)) {
	395	/* ... cancel reduced Tx power ... */
	396	if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
	397	IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
9e511c31	398	data->reduced_tx_power = false;
2b76ef13 EG	399
	400	/* ... and there is no need to get reports on RSSI any more. */
	401	ieee80211_disable_rssi_reports(vif);
	402	return;
	403	}
	404
	405	ave_rssi = ieee80211_ave_rssi(vif);
	406
	407	/* if the RSSI isn't valid, fake it is very low */
	408	if (!ave_rssi)
	409	ave_rssi = -100;
	410	if (ave_rssi > BT_ENABLE_REDUCED_TXPOWER_THRESHOLD) {
	411	if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true))
	412	IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
	413
	414	/*
	415	* bt_kill_msk can be BT_KILL_MSK_REDUCED_TXPOW only if all the
	416	* BSS / P2P clients have rssi above threshold.
	417	* We set the bt_kill_msk to BT_KILL_MSK_REDUCED_TXPOW before
	418	* the iteration, if one interface's rssi isn't good enough,
	419	* bt_kill_msk will be set to default values.
	420	*/
	421	} else if (ave_rssi < BT_DISABLE_REDUCED_TXPOWER_THRESHOLD) {
	422	if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
	423	IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
	424
	425	/*
	426	* One interface hasn't rssi above threshold, bt_kill_msk must
	427	* be set to default values.
	428	*/
9e511c31	429	data->reduced_tx_power = false;
2b76ef13 EG	430	}
	431
	432	/* Begin to monitor the RSSI: it may influence the reduced Tx power */
	433	ieee80211_enable_rssi_reports(vif, BT_DISABLE_REDUCED_TXPOWER_THRESHOLD,
	434	BT_ENABLE_REDUCED_TXPOWER_THRESHOLD);
7da052b8 EG	435	}
7da052b8 EG	436
d37cac98	437	static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm *mvm)
f421f9c3	438	{
2b76ef13	439	struct iwl_bt_iterator_data data = {
7da052b8	440	.mvm = mvm,
d37cac98	441	.notif = &mvm->last_bt_notif,
9e511c31	442	.reduced_tx_power = true,
7da052b8	443	};
f421f9c3	444
7da052b8 EG	445	ieee80211_iterate_active_interfaces_atomic(
	446	mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
	447	iwl_mvm_bt_notif_iterator, &data);
	448
2b76ef13 EG	449	/*
	450	* If there are no BSS / P2P client interfaces, reduced Tx Power is
	451	* irrelevant since it is based on the RSSI coming from the beacon.
	452	* Use BT_KILL_MSK_DEFAULT in that case.
	453	*/
9e511c31	454	data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
2b76ef13	455
9e511c31	456	if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
2b76ef13	457	IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
9166b1ee EG	458	}
	459
	460	/* upon association, the fw will send in BT Coex notification */
	461	int iwl_mvm_rx_bt_coex_notif(struct iwl_mvm *mvm,
	462	struct iwl_rx_cmd_buffer *rxb,
	463	struct iwl_device_cmd *dev_cmd)
	464	{
	465	struct iwl_rx_packet *pkt = rxb_addr(rxb);
	466	struct iwl_bt_coex_profile_notif notif = (void )pkt->data;
	467
	468
	469	IWL_DEBUG_COEX(mvm, "BT Coex Notification received\n");
	470	IWL_DEBUG_COEX(mvm, "\tBT %salive\n", notif->bt_status ? "" : "not ");
	471	IWL_DEBUG_COEX(mvm, "\tBT open conn %d\n", notif->bt_open_conn);
	472	IWL_DEBUG_COEX(mvm, "\tBT traffic load %d\n", notif->bt_traffic_load);
	473	IWL_DEBUG_COEX(mvm, "\tBT agg traffic load %d\n",
	474	notif->bt_agg_traffic_load);
	475	IWL_DEBUG_COEX(mvm, "\tBT ci compliance %d\n", notif->bt_ci_compliance);
	476
d37cac98 EG	477	/* remember this notification for future use: rssi fluctuations */
	478	memcpy(&mvm->last_bt_notif, notif, sizeof(mvm->last_bt_notif));
	479
	480	iwl_mvm_bt_coex_notif_handle(mvm);
2b76ef13 EG	481
	482	/*
	483	* This is an async handler for a notification, returning anything other
	484	* than 0 doesn't make sense even if HCMD failed.
	485	*/
	486	return 0;
	487	}
	488
	489	static void iwl_mvm_bt_rssi_iterator(void _data, u8 mac,
	490	struct ieee80211_vif *vif)
	491	{
	492	struct iwl_mvm_vif mvmvif = (void )vif->drv_priv;
	493	struct iwl_bt_iterator_data *data = _data;
	494	struct iwl_mvm *mvm = data->mvm;
	495
	496	struct ieee80211_sta *sta;
	497	struct iwl_mvm_sta *mvmsta;
	498
	499	if (vif->type != NL80211_IFTYPE_STATION \|\|
	500	mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT)
	501	return;
	502
	503	sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id],
	504	lockdep_is_held(&mvm->mutex));
	505	mvmsta = (void *)sta->drv_priv;
	506
	507	/*
	508	* This interface doesn't support reduced Tx power (because of low
	509	* RSSI probably), then set bt_kill_msk to default values.
	510	*/
	511	if (!mvmsta->bt_reduced_txpower)
9e511c31	512	data->reduced_tx_power = false;
2b76ef13 EG	513	/* else - possibly leave it to BT_KILL_MSK_REDUCED_TXPOW */
	514	}
	515
	516	void iwl_mvm_bt_rssi_event(struct iwl_mvm mvm, struct ieee80211_vif vif,
	517	enum ieee80211_rssi_event rssi_event)
	518	{
	519	struct iwl_mvm_vif mvmvif = (void )vif->drv_priv;
2b76ef13 EG	520	struct iwl_bt_iterator_data data = {
2b76ef13 EG	521	.mvm = mvm,
9e511c31	522	.reduced_tx_power = true,
2b76ef13 EG	523	};
	524	int ret;
	525
	526	mutex_lock(&mvm->mutex);
	527
	528	/* Rssi update while not associated ?! */
	529	if (WARN_ON_ONCE(mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT))
	530	goto out_unlock;
	531
	532	/* No open connection - reports should be disabled */
	533	if (!BT_MBOX_MSG(&mvm->last_bt_notif, 3, OPEN_CON_2))
	534	goto out_unlock;
	535
	536	IWL_DEBUG_COEX(mvm, "RSSI for %pM is now %s\n", vif->bss_conf.bssid,
	537	rssi_event == RSSI_EVENT_HIGH ? "HIGH" : "LOW");
	538
	539	/*
	540	* Check if rssi is good enough for reduced Tx power, but not in loose
	541	* scheme.
	542	*/
	543	if (rssi_event == RSSI_EVENT_LOW \|\| is_loose_coex())
	544	ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id,
	545	false);
f421f9c3	546	else
2b76ef13	547	ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true);
f421f9c3	548
2b76ef13 EG	549	if (ret)
2b76ef13 EG	550	IWL_ERR(mvm, "couldn't send BT_CONFIG HCMD upon RSSI event\n");
f421f9c3	551
2b76ef13 EG	552	ieee80211_iterate_active_interfaces_atomic(
	553	mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
	554	iwl_mvm_bt_rssi_iterator, &data);
f421f9c3	555
2b76ef13 EG	556	/*
	557	* If there are no BSS / P2P client interfaces, reduced Tx Power is
	558	* irrelevant since it is based on the RSSI coming from the beacon.
	559	* Use BT_KILL_MSK_DEFAULT in that case.
	560	*/
9e511c31	561	data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
f421f9c3	562
9e511c31	563	if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
2b76ef13	564	IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
f421f9c3	565
2b76ef13 EG	566	out_unlock:
2b76ef13 EG	567	mutex_unlock(&mvm->mutex);
f421f9c3	568	}
9166b1ee EG	569
	570	void iwl_mvm_bt_coex_vif_assoc(struct iwl_mvm mvm, struct ieee80211_vif vif)
	571	{
	572	struct ieee80211_chanctx_conf *chanctx_conf;
	573	enum ieee80211_band band;
	574
	575	rcu_read_lock();
	576	chanctx_conf = rcu_dereference(vif->chanctx_conf);
	577	if (chanctx_conf && chanctx_conf->def.chan)
	578	band = chanctx_conf->def.chan->band;
	579	else
	580	band = -1;
	581	rcu_read_unlock();
	582
	583	/* if we are in 2GHz we will get a notification from the fw */
	584	if (band == IEEE80211_BAND_2GHZ)
	585	return;
	586
	587	/* else, we can remove all the constraints */
	588	memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
	589
d37cac98	590	iwl_mvm_bt_coex_notif_handle(mvm);
9166b1ee	591	}