[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(0xaaaaaaaa),
	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),
};

/* single shared antenna */
static const __le32 iwl_single_shared_ant_lookup[BT_COEX_LUT_SIZE] = {
	cpu_to_le32(0x40000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x44000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x40000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0x44000000),
	cpu_to_le32(0x00000000),
	cpu_to_le32(0xC0004000),
	cpu_to_le32(0xF0005000),
	cpu_to_le32(0xC0004000),
	cpu_to_le32(0xF0005000),
};

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 (mvm->cfg->bt_shared_single_ant)
		memcpy(&cmd.decision_lut, iwl_single_shared_ant_lookup,
		       sizeof(iwl_single_shared_ant_lookup));
	else 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;

	/* non associated BSSes aren't to be considered */
	if (!vif->bss_conf.assoc)
		return;

	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;

	data->num_bss_ifaces++;

	/*
	 * 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)
{
	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),
67675831	177	cpu_to_le32(0xaaaaaaaa),
931d4160 EG	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
e715c3a9 EG	205	/* single shared antenna */
	206	static const __le32 iwl_single_shared_ant_lookup[BT_COEX_LUT_SIZE] = {
	207	cpu_to_le32(0x40000000),
	208	cpu_to_le32(0x00000000),
	209	cpu_to_le32(0x44000000),
	210	cpu_to_le32(0x00000000),
	211	cpu_to_le32(0x40000000),
	212	cpu_to_le32(0x00000000),
	213	cpu_to_le32(0x44000000),
	214	cpu_to_le32(0x00000000),
	215	cpu_to_le32(0xC0004000),
	216	cpu_to_le32(0xF0005000),
	217	cpu_to_le32(0xC0004000),
	218	cpu_to_le32(0xF0005000),
	219	};
	220
931d4160 EG	221	int iwl_send_bt_init_conf(struct iwl_mvm *mvm)
	222	{
	223	struct iwl_bt_coex_cmd cmd = {
	224	.max_kill = 5,
	225	.bt3_time_t7_value = 1,
	226	.bt3_prio_sample_time = 2,
	227	.bt3_timer_t2_value = 0xc,
	228	};
	229	int ret;
	230
	231	cmd.flags = iwlwifi_mod_params.bt_coex_active ?
	232	BT_COEX_NW : BT_COEX_DISABLE;
cf69d757	233	cmd.flags \|= BT_CH_PRIMARY_EN \| BT_SYNC_2_BT_DISABLE;
931d4160 EG	234
	235	cmd.valid_bit_msk = cpu_to_le16(BT_VALID_ENABLE \|
	236	BT_VALID_BT_PRIO_BOOST \|
	237	BT_VALID_MAX_KILL \|
	238	BT_VALID_3W_TMRS \|
	239	BT_VALID_KILL_ACK \|
	240	BT_VALID_KILL_CTS \|
	241	BT_VALID_REDUCED_TX_POWER \|
	242	BT_VALID_LUT);
	243
e715c3a9 EG	244	if (mvm->cfg->bt_shared_single_ant)
	245	memcpy(&cmd.decision_lut, iwl_single_shared_ant_lookup,
	246	sizeof(iwl_single_shared_ant_lookup));
	247	else if (is_loose_coex())
931d4160 EG	248	memcpy(&cmd.decision_lut, iwl_loose_lookup,
	249	sizeof(iwl_tight_lookup));
	250	else
	251	memcpy(&cmd.decision_lut, iwl_tight_lookup,
	252	sizeof(iwl_tight_lookup));
	253
	254	cmd.bt_prio_boost = cpu_to_le32(IWL_BT_DEFAULT_BOOST);
	255	cmd.kill_ack_msk =
	256	cpu_to_le32(iwl_bt_ack_kill_msk[BT_KILL_MSK_DEFAULT]);
	257	cmd.kill_cts_msk =
	258	cpu_to_le32(iwl_bt_cts_kill_msk[BT_KILL_MSK_DEFAULT]);
	259
2b76ef13 EG	260	memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
2b76ef13 EG	261
931d4160 EG	262	/* go to CALIB state in internal BT-Coex state machine */
	263	ret = iwl_send_bt_env(mvm, BT_COEX_ENV_OPEN,
	264	BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
	265	if (ret)
	266	return ret;
	267
	268	ret = iwl_send_bt_env(mvm, BT_COEX_ENV_CLOSE,
	269	BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
	270	if (ret)
	271	return ret;
	272
	273	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_SYNC,
	274	sizeof(cmd), &cmd);
	275	}
f421f9c3	276
2b76ef13 EG	277	static int iwl_mvm_bt_udpate_ctrl_kill_msk(struct iwl_mvm *mvm,
	278	bool reduced_tx_power)
	279	{
	280	enum iwl_bt_kill_msk bt_kill_msk;
	281	struct iwl_bt_coex_cmd cmd = {};
	282	struct iwl_bt_coex_profile_notif *notif = &mvm->last_bt_notif;
	283
	284	lockdep_assert_held(&mvm->mutex);
	285
	286	if (reduced_tx_power) {
	287	/* Reduced Tx power has precedence on the type of the profile */
	288	bt_kill_msk = BT_KILL_MSK_REDUCED_TXPOW;
	289	} else {
	290	/* Low latency BT profile is active: give higher prio to BT */
	291	if (BT_MBOX_MSG(notif, 3, SCO_STATE) \|\|
	292	BT_MBOX_MSG(notif, 3, A2DP_STATE) \|\|
	293	BT_MBOX_MSG(notif, 3, SNIFF_STATE))
	294	bt_kill_msk = BT_KILL_MSK_SCO_HID_A2DP;
	295	else
	296	bt_kill_msk = BT_KILL_MSK_DEFAULT;
	297	}
	298
	299	IWL_DEBUG_COEX(mvm,
	300	"Update kill_msk: %d - SCO %sactive A2DP %sactive SNIFF %sactive\n",
	301	bt_kill_msk,
	302	BT_MBOX_MSG(notif, 3, SCO_STATE) ? "" : "in",
	303	BT_MBOX_MSG(notif, 3, A2DP_STATE) ? "" : "in",
	304	BT_MBOX_MSG(notif, 3, SNIFF_STATE) ? "" : "in");
	305
	306	/* Don't send HCMD if there is no update */
	307	if (bt_kill_msk == mvm->bt_kill_msk)
	308	return 0;
	309
	310	mvm->bt_kill_msk = bt_kill_msk;
	311	cmd.kill_ack_msk = cpu_to_le32(iwl_bt_ack_kill_msk[bt_kill_msk]);
	312	cmd.kill_cts_msk = cpu_to_le32(iwl_bt_cts_kill_msk[bt_kill_msk]);
	313	cmd.valid_bit_msk = cpu_to_le16(BT_VALID_KILL_ACK \| BT_VALID_KILL_CTS);
	314
	315	IWL_DEBUG_COEX(mvm, "bt_kill_msk = %d\n", bt_kill_msk);
	316	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_SYNC,
	317	sizeof(cmd), &cmd);
	318	}
	319
	320	static int iwl_mvm_bt_coex_reduced_txp(struct iwl_mvm *mvm, u8 sta_id,
	321	bool enable)
	322	{
	323	struct iwl_bt_coex_cmd cmd = {
	324	.valid_bit_msk = cpu_to_le16(BT_VALID_REDUCED_TX_POWER),
	325	.bt_reduced_tx_power = sta_id,
	326	};
	327	struct ieee80211_sta *sta;
	328	struct iwl_mvm_sta *mvmsta;
	329
	330	/* This can happen if the station has been removed right now */
	331	if (sta_id == IWL_MVM_STATION_COUNT)
	332	return 0;
	333
	334	sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[sta_id],
	335	lockdep_is_held(&mvm->mutex));
	336	mvmsta = (void *)sta->drv_priv;
	337
	338	/* nothing to do */
	339	if (mvmsta->bt_reduced_txpower == enable)
	340	return 0;
341
342	if (enable)
343	cmd.bt_reduced_tx_power \|= BT_REDUCED_TX_POWER_BIT;
344
345	IWL_DEBUG_COEX(mvm, "%sable reduced Tx Power for sta %d\n",
346	enable ? "en" : "dis", sta_id);
347
348	mvmsta->bt_reduced_txpower = enable;
349
350	/* Send ASYNC since this can be sent from an atomic context */
351	return iwl_mvm_send_cmd_pdu(mvm, BT_CONFIG, CMD_ASYNC,
352	sizeof(cmd), &cmd);
353	}
354
355	struct iwl_bt_iterator_data {
7da052b8	356	struct iwl_bt_coex_profile_notif *notif;
2b76ef13 EG	357	struct iwl_mvm *mvm;
2b76ef13 EG	358	u32 num_bss_ifaces;
9e511c31	359	bool reduced_tx_power;
7da052b8 EG	360	};
	361
	362	static void iwl_mvm_bt_notif_iterator(void _data, u8 mac,
	363	struct ieee80211_vif *vif)
	364	{
	365	struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2b76ef13 EG	366	struct iwl_bt_iterator_data *data = _data;
2b76ef13 EG	367	struct iwl_mvm *mvm = data->mvm;
7da052b8 EG	368	struct ieee80211_chanctx_conf *chanctx_conf;
	369	enum ieee80211_smps_mode smps_mode;
	370	enum ieee80211_band band;
2b76ef13	371	int ave_rssi;
7da052b8	372
9ee718aa	373	lockdep_assert_held(&mvm->mutex);
7da052b8 EG	374	if (vif->type != NL80211_IFTYPE_STATION)
	375	return;
	376
	377	rcu_read_lock();
	378	chanctx_conf = rcu_dereference(vif->chanctx_conf);
	379	if (chanctx_conf && chanctx_conf->def.chan)
	380	band = chanctx_conf->def.chan->band;
	381	else
	382	band = -1;
	383	rcu_read_unlock();
	384
7da052b8 EG	385	smps_mode = IEEE80211_SMPS_AUTOMATIC;
7da052b8 EG	386
41069b46 EG	387	/* non associated BSSes aren't to be considered */
	388	if (!vif->bss_conf.assoc)
	389	return;
	390
9166b1ee	391	if (band != IEEE80211_BAND_2GHZ) {
9ee718aa EL	392	iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX,
9ee718aa EL	393	smps_mode);
9166b1ee EG	394	return;
	395	}
	396
7da052b8 EG	397	if (data->notif->bt_status)
	398	smps_mode = IEEE80211_SMPS_DYNAMIC;
	399
b9269262	400	if (data->notif->bt_traffic_load >= IWL_BT_LOAD_FORCE_SISO_THRESHOLD)
7da052b8 EG	401	smps_mode = IEEE80211_SMPS_STATIC;
	402
	403	IWL_DEBUG_COEX(data->mvm,
	404	"mac %d: bt_status %d traffic_load %d smps_req %d\n",
	405	mvmvif->id, data->notif->bt_status,
	406	data->notif->bt_traffic_load, smps_mode);
	407
9ee718aa	408	iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_BT_COEX, smps_mode);
2b76ef13 EG	409
	410	/* don't reduce the Tx power if in loose scheme */
	411	if (is_loose_coex())
	412	return;
	413
	414	data->num_bss_ifaces++;
	415
	416	/* reduced Txpower only if there are open BT connections, so ...*/
	417	if (!BT_MBOX_MSG(data->notif, 3, OPEN_CON_2)) {
	418	/* ... cancel reduced Tx power ... */
	419	if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
	420	IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
9e511c31	421	data->reduced_tx_power = false;
2b76ef13 EG	422
	423	/* ... and there is no need to get reports on RSSI any more. */
	424	ieee80211_disable_rssi_reports(vif);
	425	return;
	426	}
	427
	428	ave_rssi = ieee80211_ave_rssi(vif);
	429
	430	/* if the RSSI isn't valid, fake it is very low */
	431	if (!ave_rssi)
	432	ave_rssi = -100;
	433	if (ave_rssi > BT_ENABLE_REDUCED_TXPOWER_THRESHOLD) {
	434	if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true))
	435	IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
	436
	437	/*
	438	* bt_kill_msk can be BT_KILL_MSK_REDUCED_TXPOW only if all the
	439	* BSS / P2P clients have rssi above threshold.
	440	* We set the bt_kill_msk to BT_KILL_MSK_REDUCED_TXPOW before
	441	* the iteration, if one interface's rssi isn't good enough,
	442	* bt_kill_msk will be set to default values.
	443	*/
	444	} else if (ave_rssi < BT_DISABLE_REDUCED_TXPOWER_THRESHOLD) {
	445	if (iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, false))
	446	IWL_ERR(mvm, "Couldn't send BT_CONFIG cmd\n");
	447
	448	/*
	449	* One interface hasn't rssi above threshold, bt_kill_msk must
	450	* be set to default values.
	451	*/
9e511c31	452	data->reduced_tx_power = false;
2b76ef13 EG	453	}
	454
	455	/* Begin to monitor the RSSI: it may influence the reduced Tx power */
	456	ieee80211_enable_rssi_reports(vif, BT_DISABLE_REDUCED_TXPOWER_THRESHOLD,
	457	BT_ENABLE_REDUCED_TXPOWER_THRESHOLD);
7da052b8 EG	458	}
7da052b8 EG	459
d37cac98	460	static void iwl_mvm_bt_coex_notif_handle(struct iwl_mvm *mvm)
f421f9c3	461	{
2b76ef13	462	struct iwl_bt_iterator_data data = {
7da052b8	463	.mvm = mvm,
d37cac98	464	.notif = &mvm->last_bt_notif,
9e511c31	465	.reduced_tx_power = true,
7da052b8	466	};
f421f9c3	467
7da052b8 EG	468	ieee80211_iterate_active_interfaces_atomic(
	469	mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
	470	iwl_mvm_bt_notif_iterator, &data);
	471
2b76ef13 EG	472	/*
	473	* If there are no BSS / P2P client interfaces, reduced Tx Power is
	474	* irrelevant since it is based on the RSSI coming from the beacon.
	475	* Use BT_KILL_MSK_DEFAULT in that case.
	476	*/
9e511c31	477	data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
2b76ef13	478
9e511c31	479	if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
2b76ef13	480	IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
9166b1ee EG	481	}
	482
	483	/* upon association, the fw will send in BT Coex notification */
	484	int iwl_mvm_rx_bt_coex_notif(struct iwl_mvm *mvm,
	485	struct iwl_rx_cmd_buffer *rxb,
	486	struct iwl_device_cmd *dev_cmd)
	487	{
	488	struct iwl_rx_packet *pkt = rxb_addr(rxb);
	489	struct iwl_bt_coex_profile_notif notif = (void )pkt->data;
	490
	491
	492	IWL_DEBUG_COEX(mvm, "BT Coex Notification received\n");
	493	IWL_DEBUG_COEX(mvm, "\tBT %salive\n", notif->bt_status ? "" : "not ");
	494	IWL_DEBUG_COEX(mvm, "\tBT open conn %d\n", notif->bt_open_conn);
	495	IWL_DEBUG_COEX(mvm, "\tBT traffic load %d\n", notif->bt_traffic_load);
	496	IWL_DEBUG_COEX(mvm, "\tBT agg traffic load %d\n",
	497	notif->bt_agg_traffic_load);
	498	IWL_DEBUG_COEX(mvm, "\tBT ci compliance %d\n", notif->bt_ci_compliance);
	499
d37cac98 EG	500	/* remember this notification for future use: rssi fluctuations */
	501	memcpy(&mvm->last_bt_notif, notif, sizeof(mvm->last_bt_notif));
	502
	503	iwl_mvm_bt_coex_notif_handle(mvm);
2b76ef13 EG	504
	505	/*
	506	* This is an async handler for a notification, returning anything other
	507	* than 0 doesn't make sense even if HCMD failed.
	508	*/
	509	return 0;
	510	}
	511
	512	static void iwl_mvm_bt_rssi_iterator(void _data, u8 mac,
	513	struct ieee80211_vif *vif)
	514	{
	515	struct iwl_mvm_vif mvmvif = (void )vif->drv_priv;
	516	struct iwl_bt_iterator_data *data = _data;
	517	struct iwl_mvm *mvm = data->mvm;
	518
	519	struct ieee80211_sta *sta;
	520	struct iwl_mvm_sta *mvmsta;
	521
	522	if (vif->type != NL80211_IFTYPE_STATION \|\|
	523	mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT)
	524	return;
	525
	526	sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[mvmvif->ap_sta_id],
	527	lockdep_is_held(&mvm->mutex));
	528	mvmsta = (void *)sta->drv_priv;
	529
8e0366f9 EG	530	data->num_bss_ifaces++;
8e0366f9 EG	531
2b76ef13 EG	532	/*
	533	* This interface doesn't support reduced Tx power (because of low
	534	* RSSI probably), then set bt_kill_msk to default values.
	535	*/
	536	if (!mvmsta->bt_reduced_txpower)
9e511c31	537	data->reduced_tx_power = false;
2b76ef13 EG	538	/* else - possibly leave it to BT_KILL_MSK_REDUCED_TXPOW */
	539	}
	540
	541	void iwl_mvm_bt_rssi_event(struct iwl_mvm mvm, struct ieee80211_vif vif,
	542	enum ieee80211_rssi_event rssi_event)
	543	{
	544	struct iwl_mvm_vif mvmvif = (void )vif->drv_priv;
2b76ef13 EG	545	struct iwl_bt_iterator_data data = {
2b76ef13 EG	546	.mvm = mvm,
9e511c31	547	.reduced_tx_power = true,
2b76ef13 EG	548	};
	549	int ret;
	550
	551	mutex_lock(&mvm->mutex);
	552
	553	/* Rssi update while not associated ?! */
	554	if (WARN_ON_ONCE(mvmvif->ap_sta_id == IWL_MVM_STATION_COUNT))
	555	goto out_unlock;
	556
	557	/* No open connection - reports should be disabled */
	558	if (!BT_MBOX_MSG(&mvm->last_bt_notif, 3, OPEN_CON_2))
	559	goto out_unlock;
	560
	561	IWL_DEBUG_COEX(mvm, "RSSI for %pM is now %s\n", vif->bss_conf.bssid,
	562	rssi_event == RSSI_EVENT_HIGH ? "HIGH" : "LOW");
	563
	564	/*
	565	* Check if rssi is good enough for reduced Tx power, but not in loose
	566	* scheme.
	567	*/
	568	if (rssi_event == RSSI_EVENT_LOW \|\| is_loose_coex())
	569	ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id,
	570	false);
f421f9c3	571	else
2b76ef13	572	ret = iwl_mvm_bt_coex_reduced_txp(mvm, mvmvif->ap_sta_id, true);
f421f9c3	573
2b76ef13 EG	574	if (ret)
2b76ef13 EG	575	IWL_ERR(mvm, "couldn't send BT_CONFIG HCMD upon RSSI event\n");
f421f9c3	576
2b76ef13 EG	577	ieee80211_iterate_active_interfaces_atomic(
	578	mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
	579	iwl_mvm_bt_rssi_iterator, &data);
f421f9c3	580
2b76ef13 EG	581	/*
	582	* If there are no BSS / P2P client interfaces, reduced Tx Power is
	583	* irrelevant since it is based on the RSSI coming from the beacon.
	584	* Use BT_KILL_MSK_DEFAULT in that case.
	585	*/
9e511c31	586	data.reduced_tx_power = data.reduced_tx_power && data.num_bss_ifaces;
f421f9c3	587
9e511c31	588	if (iwl_mvm_bt_udpate_ctrl_kill_msk(mvm, data.reduced_tx_power))
2b76ef13	589	IWL_ERR(mvm, "Failed to update the ctrl_kill_msk\n");
f421f9c3	590
2b76ef13 EG	591	out_unlock:
2b76ef13 EG	592	mutex_unlock(&mvm->mutex);
f421f9c3	593	}
9166b1ee EG	594
	595	void iwl_mvm_bt_coex_vif_assoc(struct iwl_mvm mvm, struct ieee80211_vif vif)
	596	{
d37cac98	597	iwl_mvm_bt_coex_notif_handle(mvm);
9166b1ee	598	}