drivers/net/wireless/iwlwifi/dvm/devices.c - kernel/msm-4.9 - Gitiles

 /******************************************************************************
  *
  * Copyright(c) 2008 - 2012 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 LICENSE.
  *
  * Contact Information:
  *  Intel Linux Wireless <ilw@linux.intel.com>
  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  *
  *****************************************************************************/

 /*
  * DVM device-specific data & functions
  */
 #include "iwl-io.h"
 #include "iwl-prph.h"
 #include "iwl-eeprom-parse.h"

 #include "agn.h"
 #include "dev.h"
 #include "commands.h"


 /*
  * 1000 series
  * ===========
  */

 /*
  * For 1000, use advance thermal throttling critical temperature threshold,
  * but legacy thermal management implementation for now.
  * This is for the reason of 1000 uCode using advance thermal throttling API
  * but not implement ct_kill_exit based on ct_kill exit temperature
  * so the thermal throttling will still based on legacy thermal throttling
  * management.
  * The code here need to be modified once 1000 uCode has the advanced thermal
  * throttling algorithm in place
  */
 static void iwl1000_set_ct_threshold(struct iwl_priv *priv)
 {
 	/* want Celsius */
 	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD_LEGACY;
 	priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
 }

 /* NIC configuration for 1000 series */
 static void iwl1000_nic_config(struct iwl_priv *priv)
 {
 	/* Setting digital SVR for 1000 card to 1.32V */
 	/* locking is acquired in iwl_set_bits_mask_prph() function */
 	iwl_set_bits_mask_prph(priv->trans, APMG_DIGITAL_SVR_REG,
 				APMG_SVR_DIGITAL_VOLTAGE_1_32,
 				~APMG_SVR_VOLTAGE_CONFIG_BIT_MSK);
 }

 /**
  * iwl_beacon_time_mask_low - mask of lower 32 bit of beacon time
  * @priv -- pointer to iwl_priv data structure
  * @tsf_bits -- number of bits need to shift for masking)
  */
 static inline u32 iwl_beacon_time_mask_low(struct iwl_priv *priv,
 					   u16 tsf_bits)
 {
 	return (1 << tsf_bits) - 1;
 }

 /**
  * iwl_beacon_time_mask_high - mask of higher 32 bit of beacon time
  * @priv -- pointer to iwl_priv data structure
  * @tsf_bits -- number of bits need to shift for masking)
  */
 static inline u32 iwl_beacon_time_mask_high(struct iwl_priv *priv,
 					    u16 tsf_bits)
 {
 	return ((1 << (32 - tsf_bits)) - 1) << tsf_bits;
 }

 /*
  * extended beacon time format
  * time in usec will be changed into a 32-bit value in extended:internal format
  * the extended part is the beacon counts
  * the internal part is the time in usec within one beacon interval
  */
 static u32 iwl_usecs_to_beacons(struct iwl_priv *priv, u32 usec,
 				u32 beacon_interval)
 {
 	u32 quot;
 	u32 rem;
 	u32 interval = beacon_interval * TIME_UNIT;

 	if (!interval || !usec)
 		return 0;

 	quot = (usec / interval) &
 		(iwl_beacon_time_mask_high(priv, IWLAGN_EXT_BEACON_TIME_POS) >>
 		IWLAGN_EXT_BEACON_TIME_POS);
 	rem = (usec % interval) & iwl_beacon_time_mask_low(priv,
 				   IWLAGN_EXT_BEACON_TIME_POS);

 	return (quot << IWLAGN_EXT_BEACON_TIME_POS) + rem;
 }

 /* base is usually what we get from ucode with each received frame,
  * the same as HW timer counter counting down
  */
 static __le32 iwl_add_beacon_time(struct iwl_priv *priv, u32 base,
 			   u32 addon, u32 beacon_interval)
 {
 	u32 base_low = base & iwl_beacon_time_mask_low(priv,
 				IWLAGN_EXT_BEACON_TIME_POS);
 	u32 addon_low = addon & iwl_beacon_time_mask_low(priv,
 				IWLAGN_EXT_BEACON_TIME_POS);
 	u32 interval = beacon_interval * TIME_UNIT;
 	u32 res = (base & iwl_beacon_time_mask_high(priv,
 				IWLAGN_EXT_BEACON_TIME_POS)) +
 				(addon & iwl_beacon_time_mask_high(priv,
 				IWLAGN_EXT_BEACON_TIME_POS));

 	if (base_low > addon_low)
 		res += base_low - addon_low;
 	else if (base_low < addon_low) {
 		res += interval + base_low - addon_low;
 		res += (1 << IWLAGN_EXT_BEACON_TIME_POS);
 	} else
 		res += (1 << IWLAGN_EXT_BEACON_TIME_POS);

 	return cpu_to_le32(res);
 }

 static const struct iwl_sensitivity_ranges iwl1000_sensitivity = {
 	.min_nrg_cck = 95,
 	.auto_corr_min_ofdm = 90,
 	.auto_corr_min_ofdm_mrc = 170,
 	.auto_corr_min_ofdm_x1 = 120,
 	.auto_corr_min_ofdm_mrc_x1 = 240,

 	.auto_corr_max_ofdm = 120,
 	.auto_corr_max_ofdm_mrc = 210,
 	.auto_corr_max_ofdm_x1 = 155,
 	.auto_corr_max_ofdm_mrc_x1 = 290,

 	.auto_corr_min_cck = 125,
 	.auto_corr_max_cck = 200,
 	.auto_corr_min_cck_mrc = 170,
 	.auto_corr_max_cck_mrc = 400,
 	.nrg_th_cck = 95,
 	.nrg_th_ofdm = 95,

 	.barker_corr_th_min = 190,
 	.barker_corr_th_min_mrc = 390,
 	.nrg_th_cca = 62,
 };

 static void iwl1000_hw_set_hw_params(struct iwl_priv *priv)
 {
 	iwl1000_set_ct_threshold(priv);

 	/* Set initial sensitivity parameters */
 	priv->hw_params.sens = &iwl1000_sensitivity;
 }

 struct iwl_lib_ops iwl1000_lib = {
 	.set_hw_params = iwl1000_hw_set_hw_params,
 	.nic_config = iwl1000_nic_config,
 	.temperature = iwlagn_temperature,
 };


 /*
  * 2000 series
  * ===========
  */

 static void iwl2000_set_ct_threshold(struct iwl_priv *priv)
 {
 	/* want Celsius */
 	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD;
 	priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
 }

 /* NIC configuration for 2000 series */
 static void iwl2000_nic_config(struct iwl_priv *priv)
 {
 	iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 		    CSR_GP_DRIVER_REG_BIT_RADIO_IQ_INVER);
 }

 static const struct iwl_sensitivity_ranges iwl2000_sensitivity = {
 	.min_nrg_cck = 97,
 	.auto_corr_min_ofdm = 80,
 	.auto_corr_min_ofdm_mrc = 128,
 	.auto_corr_min_ofdm_x1 = 105,
 	.auto_corr_min_ofdm_mrc_x1 = 192,

 	.auto_corr_max_ofdm = 145,
 	.auto_corr_max_ofdm_mrc = 232,
 	.auto_corr_max_ofdm_x1 = 110,
 	.auto_corr_max_ofdm_mrc_x1 = 232,

 	.auto_corr_min_cck = 125,
 	.auto_corr_max_cck = 175,
 	.auto_corr_min_cck_mrc = 160,
 	.auto_corr_max_cck_mrc = 310,
 	.nrg_th_cck = 97,
 	.nrg_th_ofdm = 100,

 	.barker_corr_th_min = 190,
 	.barker_corr_th_min_mrc = 390,
 	.nrg_th_cca = 62,
 };

 static void iwl2000_hw_set_hw_params(struct iwl_priv *priv)
 {
 	iwl2000_set_ct_threshold(priv);

 	/* Set initial sensitivity parameters */
 	priv->hw_params.sens = &iwl2000_sensitivity;
 }

 struct iwl_lib_ops iwl2000_lib = {
 	.set_hw_params = iwl2000_hw_set_hw_params,
 	.nic_config = iwl2000_nic_config,
 	.temperature = iwlagn_temperature,
 };

 struct iwl_lib_ops iwl2030_lib = {
 	.set_hw_params = iwl2000_hw_set_hw_params,
 	.nic_config = iwl2000_nic_config,
 	.temperature = iwlagn_temperature,
 };

 /*
  * 5000 series
  * ===========
  */

 /* NIC configuration for 5000 series */
 static const struct iwl_sensitivity_ranges iwl5000_sensitivity = {
 	.min_nrg_cck = 100,
 	.auto_corr_min_ofdm = 90,
 	.auto_corr_min_ofdm_mrc = 170,
 	.auto_corr_min_ofdm_x1 = 105,
 	.auto_corr_min_ofdm_mrc_x1 = 220,

 	.auto_corr_max_ofdm = 120,
 	.auto_corr_max_ofdm_mrc = 210,
 	.auto_corr_max_ofdm_x1 = 120,
 	.auto_corr_max_ofdm_mrc_x1 = 240,

 	.auto_corr_min_cck = 125,
 	.auto_corr_max_cck = 200,
 	.auto_corr_min_cck_mrc = 200,
 	.auto_corr_max_cck_mrc = 400,
 	.nrg_th_cck = 100,
 	.nrg_th_ofdm = 100,

 	.barker_corr_th_min = 190,
 	.barker_corr_th_min_mrc = 390,
 	.nrg_th_cca = 62,
 };

 static struct iwl_sensitivity_ranges iwl5150_sensitivity = {
 	.min_nrg_cck = 95,
 	.auto_corr_min_ofdm = 90,
 	.auto_corr_min_ofdm_mrc = 170,
 	.auto_corr_min_ofdm_x1 = 105,
 	.auto_corr_min_ofdm_mrc_x1 = 220,

 	.auto_corr_max_ofdm = 120,
 	.auto_corr_max_ofdm_mrc = 210,
 	/* max = min for performance bug in 5150 DSP */
 	.auto_corr_max_ofdm_x1 = 105,
 	.auto_corr_max_ofdm_mrc_x1 = 220,

 	.auto_corr_min_cck = 125,
 	.auto_corr_max_cck = 200,
 	.auto_corr_min_cck_mrc = 170,
 	.auto_corr_max_cck_mrc = 400,
 	.nrg_th_cck = 95,
 	.nrg_th_ofdm = 95,

 	.barker_corr_th_min = 190,
 	.barker_corr_th_min_mrc = 390,
 	.nrg_th_cca = 62,
 };

 #define IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF	(-5)

 static s32 iwl_temp_calib_to_offset(struct iwl_priv *priv)
 {
 	u16 temperature, voltage;

 	temperature = le16_to_cpu(priv->eeprom_data->kelvin_temperature);
 	voltage = le16_to_cpu(priv->eeprom_data->kelvin_voltage);

 	/* offset = temp - volt / coeff */
 	return (s32)(temperature -
 			voltage / IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF);
 }

 static void iwl5150_set_ct_threshold(struct iwl_priv *priv)
 {
 	const s32 volt2temp_coef = IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF;
 	s32 threshold = (s32)CELSIUS_TO_KELVIN(CT_KILL_THRESHOLD_LEGACY) -
 			iwl_temp_calib_to_offset(priv);

 	priv->hw_params.ct_kill_threshold = threshold * volt2temp_coef;
 }

 static void iwl5000_set_ct_threshold(struct iwl_priv *priv)
 {
 	/* want Celsius */
 	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD_LEGACY;
 }

 static void iwl5000_hw_set_hw_params(struct iwl_priv *priv)
 {
 	iwl5000_set_ct_threshold(priv);

 	/* Set initial sensitivity parameters */
 	priv->hw_params.sens = &iwl5000_sensitivity;
 }

 static void iwl5150_hw_set_hw_params(struct iwl_priv *priv)
 {
 	iwl5150_set_ct_threshold(priv);

 	/* Set initial sensitivity parameters */
 	priv->hw_params.sens = &iwl5150_sensitivity;
 }

 static void iwl5150_temperature(struct iwl_priv *priv)
 {
 	u32 vt = 0;
 	s32 offset =  iwl_temp_calib_to_offset(priv);

 	vt = le32_to_cpu(priv->statistics.common.temperature);
 	vt = vt / IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF + offset;
 	/* now vt hold the temperature in Kelvin */
 	priv->temperature = KELVIN_TO_CELSIUS(vt);
 	iwl_tt_handler(priv);
 }

 static int iwl5000_hw_channel_switch(struct iwl_priv *priv,
 				     struct ieee80211_channel_switch *ch_switch)
 {
 	/*
 	 * MULTI-FIXME
 	 * See iwlagn_mac_channel_switch.
 	 */
 	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
 	struct iwl5000_channel_switch_cmd cmd;
 	u32 switch_time_in_usec, ucode_switch_time;
 	u16 ch;
 	u32 tsf_low;
 	u8 switch_count;
 	u16 beacon_interval = le16_to_cpu(ctx->timing.beacon_interval);
 	struct ieee80211_vif *vif = ctx->vif;
 	struct iwl_host_cmd hcmd = {
 		.id = REPLY_CHANNEL_SWITCH,
 		.len = { sizeof(cmd), },
 		.flags = CMD_SYNC,
 		.data = { &cmd, },
 	};

 	cmd.band = priv->band == IEEE80211_BAND_2GHZ;
 	ch = ch_switch->channel->hw_value;
 	IWL_DEBUG_11H(priv, "channel switch from %d to %d\n",
 		      ctx->active.channel, ch);
 	cmd.channel = cpu_to_le16(ch);
 	cmd.rxon_flags = ctx->staging.flags;
 	cmd.rxon_filter_flags = ctx->staging.filter_flags;
 	switch_count = ch_switch->count;
 	tsf_low = ch_switch->timestamp & 0x0ffffffff;
 	/*
 	 * calculate the ucode channel switch time
 	 * adding TSF as one of the factor for when to switch
 	 */
 	if ((priv->ucode_beacon_time > tsf_low) && beacon_interval) {
 		if (switch_count > ((priv->ucode_beacon_time - tsf_low) /
 		    beacon_interval)) {
 			switch_count -= (priv->ucode_beacon_time -
 				tsf_low) / beacon_interval;
 		} else
 			switch_count = 0;
 	}
 	if (switch_count <= 1)
 		cmd.switch_time = cpu_to_le32(priv->ucode_beacon_time);
 	else {
 		switch_time_in_usec =
 			vif->bss_conf.beacon_int * switch_count * TIME_UNIT;
 		ucode_switch_time = iwl_usecs_to_beacons(priv,
 							 switch_time_in_usec,
 							 beacon_interval);
 		cmd.switch_time = iwl_add_beacon_time(priv,
 						      priv->ucode_beacon_time,
 						      ucode_switch_time,
 						      beacon_interval);
 	}
 	IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
 		      cmd.switch_time);
 	cmd.expect_beacon = ch_switch->channel->flags & IEEE80211_CHAN_RADAR;

 	return iwl_dvm_send_cmd(priv, &hcmd);
 }

 struct iwl_lib_ops iwl5000_lib = {
 	.set_hw_params = iwl5000_hw_set_hw_params,
 	.set_channel_switch = iwl5000_hw_channel_switch,
 	.temperature = iwlagn_temperature,
 };

 struct iwl_lib_ops iwl5150_lib = {
 	.set_hw_params = iwl5150_hw_set_hw_params,
 	.set_channel_switch = iwl5000_hw_channel_switch,
 	.temperature = iwl5150_temperature,
 };


 /*
  * 6000 series
  * ===========
  */

 static void iwl6000_set_ct_threshold(struct iwl_priv *priv)
 {
 	/* want Celsius */
 	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD;
 	priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
 }

 /* NIC configuration for 6000 series */
 static void iwl6000_nic_config(struct iwl_priv *priv)
 {
 	switch (priv->cfg->device_family) {
 	case IWL_DEVICE_FAMILY_6005:
 	case IWL_DEVICE_FAMILY_6030:
 	case IWL_DEVICE_FAMILY_6000:
 		break;
 	case IWL_DEVICE_FAMILY_6000i:
 		/* 2x2 IPA phy type */
 		iwl_write32(priv->trans, CSR_GP_DRIVER_REG,
 			     CSR_GP_DRIVER_REG_BIT_RADIO_SKU_2x2_IPA);
 		break;
 	case IWL_DEVICE_FAMILY_6050:
 		/* Indicate calibration version to uCode. */
 		if (priv->eeprom_data->calib_version >= 6)
 			iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 					CSR_GP_DRIVER_REG_BIT_CALIB_VERSION6);
 		break;
 	case IWL_DEVICE_FAMILY_6150:
 		/* Indicate calibration version to uCode. */
 		if (priv->eeprom_data->calib_version >= 6)
 			iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 					CSR_GP_DRIVER_REG_BIT_CALIB_VERSION6);
 		iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 			    CSR_GP_DRIVER_REG_BIT_6050_1x2);
 		break;
 	default:
 		WARN_ON(1);
 	}
 }

 static const struct iwl_sensitivity_ranges iwl6000_sensitivity = {
 	.min_nrg_cck = 110,
 	.auto_corr_min_ofdm = 80,
 	.auto_corr_min_ofdm_mrc = 128,
 	.auto_corr_min_ofdm_x1 = 105,
 	.auto_corr_min_ofdm_mrc_x1 = 192,

 	.auto_corr_max_ofdm = 145,
 	.auto_corr_max_ofdm_mrc = 232,
 	.auto_corr_max_ofdm_x1 = 110,
 	.auto_corr_max_ofdm_mrc_x1 = 232,

 	.auto_corr_min_cck = 125,
 	.auto_corr_max_cck = 175,
 	.auto_corr_min_cck_mrc = 160,
 	.auto_corr_max_cck_mrc = 310,
 	.nrg_th_cck = 110,
 	.nrg_th_ofdm = 110,

 	.barker_corr_th_min = 190,
 	.barker_corr_th_min_mrc = 336,
 	.nrg_th_cca = 62,
 };

 static void iwl6000_hw_set_hw_params(struct iwl_priv *priv)
 {
 	iwl6000_set_ct_threshold(priv);

 	/* Set initial sensitivity parameters */
 	priv->hw_params.sens = &iwl6000_sensitivity;

 }

 static int iwl6000_hw_channel_switch(struct iwl_priv *priv,
 				     struct ieee80211_channel_switch *ch_switch)
 {
 	/*
 	 * MULTI-FIXME
 	 * See iwlagn_mac_channel_switch.
 	 */
 	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
 	struct iwl6000_channel_switch_cmd *cmd;
 	u32 switch_time_in_usec, ucode_switch_time;
 	u16 ch;
 	u32 tsf_low;
 	u8 switch_count;
 	u16 beacon_interval = le16_to_cpu(ctx->timing.beacon_interval);
 	struct ieee80211_vif *vif = ctx->vif;
 	struct iwl_host_cmd hcmd = {
 		.id = REPLY_CHANNEL_SWITCH,
 		.len = { sizeof(*cmd), },
 		.flags = CMD_SYNC,
 		.dataflags[0] = IWL_HCMD_DFL_NOCOPY,
 	};
 	int err;

 	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
 	if (!cmd)
 		return -ENOMEM;

 	hcmd.data[0] = cmd;

 	cmd->band = priv->band == IEEE80211_BAND_2GHZ;
 	ch = ch_switch->channel->hw_value;
 	IWL_DEBUG_11H(priv, "channel switch from %u to %u\n",
 		      ctx->active.channel, ch);
 	cmd->channel = cpu_to_le16(ch);
 	cmd->rxon_flags = ctx->staging.flags;
 	cmd->rxon_filter_flags = ctx->staging.filter_flags;
 	switch_count = ch_switch->count;
 	tsf_low = ch_switch->timestamp & 0x0ffffffff;
 	/*
 	 * calculate the ucode channel switch time
 	 * adding TSF as one of the factor for when to switch
 	 */
 	if ((priv->ucode_beacon_time > tsf_low) && beacon_interval) {
 		if (switch_count > ((priv->ucode_beacon_time - tsf_low) /
 		    beacon_interval)) {
 			switch_count -= (priv->ucode_beacon_time -
 				tsf_low) / beacon_interval;
 		} else
 			switch_count = 0;
 	}
 	if (switch_count <= 1)
 		cmd->switch_time = cpu_to_le32(priv->ucode_beacon_time);
 	else {
 		switch_time_in_usec =
 			vif->bss_conf.beacon_int * switch_count * TIME_UNIT;
 		ucode_switch_time = iwl_usecs_to_beacons(priv,
 							 switch_time_in_usec,
 							 beacon_interval);
 		cmd->switch_time = iwl_add_beacon_time(priv,
 						       priv->ucode_beacon_time,
 						       ucode_switch_time,
 						       beacon_interval);
 	}
 	IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
 		      cmd->switch_time);
 	cmd->expect_beacon = ch_switch->channel->flags & IEEE80211_CHAN_RADAR;

 	err = iwl_dvm_send_cmd(priv, &hcmd);
 	kfree(cmd);
 	return err;
 }

 struct iwl_lib_ops iwl6000_lib = {
 	.set_hw_params = iwl6000_hw_set_hw_params,
 	.set_channel_switch = iwl6000_hw_channel_switch,
 	.nic_config = iwl6000_nic_config,
 	.temperature = iwlagn_temperature,
 };

 struct iwl_lib_ops iwl6030_lib = {
 	.set_hw_params = iwl6000_hw_set_hw_params,
 	.set_channel_switch = iwl6000_hw_channel_switch,
 	.nic_config = iwl6000_nic_config,
 	.temperature = iwlagn_temperature,
 };
	/******************************************************************************
	*
	* Copyright(c) 2008 - 2012 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 LICENSE.
	*
	* Contact Information:
	* Intel Linux Wireless <ilw@linux.intel.com>
	* Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
	*
	*****************************************************************************/

	/*
	* DVM device-specific data & functions
	*/
	#include "iwl-io.h"
	#include "iwl-prph.h"
	#include "iwl-eeprom-parse.h"

	#include "agn.h"
	#include "dev.h"
	#include "commands.h"


	/*
	* 1000 series
	* ===========
	*/

	/*
	* For 1000, use advance thermal throttling critical temperature threshold,
	* but legacy thermal management implementation for now.
	* This is for the reason of 1000 uCode using advance thermal throttling API
	* but not implement ct_kill_exit based on ct_kill exit temperature
	* so the thermal throttling will still based on legacy thermal throttling
	* management.
	* The code here need to be modified once 1000 uCode has the advanced thermal
	* throttling algorithm in place
	*/
	static void iwl1000_set_ct_threshold(struct iwl_priv *priv)
	{
	/* want Celsius */
	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD_LEGACY;
	priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
	}

	/* NIC configuration for 1000 series */
	static void iwl1000_nic_config(struct iwl_priv *priv)
	{
	/* Setting digital SVR for 1000 card to 1.32V */
	/* locking is acquired in iwl_set_bits_mask_prph() function */
	iwl_set_bits_mask_prph(priv->trans, APMG_DIGITAL_SVR_REG,
	APMG_SVR_DIGITAL_VOLTAGE_1_32,
	~APMG_SVR_VOLTAGE_CONFIG_BIT_MSK);
	}

	/**
	* iwl_beacon_time_mask_low - mask of lower 32 bit of beacon time
	* @priv -- pointer to iwl_priv data structure
	* @tsf_bits -- number of bits need to shift for masking)
	*/
	static inline u32 iwl_beacon_time_mask_low(struct iwl_priv *priv,
	u16 tsf_bits)
	{
	return (1 << tsf_bits) - 1;
	}

	/**
	* iwl_beacon_time_mask_high - mask of higher 32 bit of beacon time
	* @priv -- pointer to iwl_priv data structure
	* @tsf_bits -- number of bits need to shift for masking)
	*/
	static inline u32 iwl_beacon_time_mask_high(struct iwl_priv *priv,
	u16 tsf_bits)
	{
	return ((1 << (32 - tsf_bits)) - 1) << tsf_bits;
	}

	/*
	* extended beacon time format
	* time in usec will be changed into a 32-bit value in extended:internal format
	* the extended part is the beacon counts
	* the internal part is the time in usec within one beacon interval
	*/
	static u32 iwl_usecs_to_beacons(struct iwl_priv *priv, u32 usec,
	u32 beacon_interval)
	{
	u32 quot;
	u32 rem;
	u32 interval = beacon_interval * TIME_UNIT;

	if (!interval \|\| !usec)
	return 0;

	quot = (usec / interval) &
	(iwl_beacon_time_mask_high(priv, IWLAGN_EXT_BEACON_TIME_POS) >>
	IWLAGN_EXT_BEACON_TIME_POS);
	rem = (usec % interval) & iwl_beacon_time_mask_low(priv,
	IWLAGN_EXT_BEACON_TIME_POS);

	return (quot << IWLAGN_EXT_BEACON_TIME_POS) + rem;
	}

	/* base is usually what we get from ucode with each received frame,
	* the same as HW timer counter counting down
	*/
	static __le32 iwl_add_beacon_time(struct iwl_priv *priv, u32 base,
	u32 addon, u32 beacon_interval)
	{
	u32 base_low = base & iwl_beacon_time_mask_low(priv,
	IWLAGN_EXT_BEACON_TIME_POS);
	u32 addon_low = addon & iwl_beacon_time_mask_low(priv,
	IWLAGN_EXT_BEACON_TIME_POS);
	u32 interval = beacon_interval * TIME_UNIT;
	u32 res = (base & iwl_beacon_time_mask_high(priv,
	IWLAGN_EXT_BEACON_TIME_POS)) +
	(addon & iwl_beacon_time_mask_high(priv,
	IWLAGN_EXT_BEACON_TIME_POS));

	if (base_low > addon_low)
	res += base_low - addon_low;
	else if (base_low < addon_low) {
	res += interval + base_low - addon_low;
	res += (1 << IWLAGN_EXT_BEACON_TIME_POS);
	} else
	res += (1 << IWLAGN_EXT_BEACON_TIME_POS);

	return cpu_to_le32(res);
	}

	static const struct iwl_sensitivity_ranges iwl1000_sensitivity = {
	.min_nrg_cck = 95,
	.auto_corr_min_ofdm = 90,
	.auto_corr_min_ofdm_mrc = 170,
	.auto_corr_min_ofdm_x1 = 120,
	.auto_corr_min_ofdm_mrc_x1 = 240,

	.auto_corr_max_ofdm = 120,
	.auto_corr_max_ofdm_mrc = 210,
	.auto_corr_max_ofdm_x1 = 155,
	.auto_corr_max_ofdm_mrc_x1 = 290,

	.auto_corr_min_cck = 125,
	.auto_corr_max_cck = 200,
	.auto_corr_min_cck_mrc = 170,
	.auto_corr_max_cck_mrc = 400,
	.nrg_th_cck = 95,
	.nrg_th_ofdm = 95,

	.barker_corr_th_min = 190,
	.barker_corr_th_min_mrc = 390,
	.nrg_th_cca = 62,
	};

	static void iwl1000_hw_set_hw_params(struct iwl_priv *priv)
	{
	iwl1000_set_ct_threshold(priv);

	/* Set initial sensitivity parameters */
	priv->hw_params.sens = &iwl1000_sensitivity;
	}

	struct iwl_lib_ops iwl1000_lib = {
	.set_hw_params = iwl1000_hw_set_hw_params,
	.nic_config = iwl1000_nic_config,
	.temperature = iwlagn_temperature,
	};


	/*
	* 2000 series
	* ===========
	*/

	static void iwl2000_set_ct_threshold(struct iwl_priv *priv)
	{
	/* want Celsius */
	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD;
	priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
	}

	/* NIC configuration for 2000 series */
	static void iwl2000_nic_config(struct iwl_priv *priv)
	{
	iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
	CSR_GP_DRIVER_REG_BIT_RADIO_IQ_INVER);
	}

	static const struct iwl_sensitivity_ranges iwl2000_sensitivity = {
	.min_nrg_cck = 97,
	.auto_corr_min_ofdm = 80,
	.auto_corr_min_ofdm_mrc = 128,
	.auto_corr_min_ofdm_x1 = 105,
	.auto_corr_min_ofdm_mrc_x1 = 192,

	.auto_corr_max_ofdm = 145,
	.auto_corr_max_ofdm_mrc = 232,
	.auto_corr_max_ofdm_x1 = 110,
	.auto_corr_max_ofdm_mrc_x1 = 232,

	.auto_corr_min_cck = 125,
	.auto_corr_max_cck = 175,
	.auto_corr_min_cck_mrc = 160,
	.auto_corr_max_cck_mrc = 310,
	.nrg_th_cck = 97,
	.nrg_th_ofdm = 100,

	.barker_corr_th_min = 190,
	.barker_corr_th_min_mrc = 390,
	.nrg_th_cca = 62,
	};

	static void iwl2000_hw_set_hw_params(struct iwl_priv *priv)
	{
	iwl2000_set_ct_threshold(priv);

	/* Set initial sensitivity parameters */
	priv->hw_params.sens = &iwl2000_sensitivity;
	}

	struct iwl_lib_ops iwl2000_lib = {
	.set_hw_params = iwl2000_hw_set_hw_params,
	.nic_config = iwl2000_nic_config,
	.temperature = iwlagn_temperature,
	};

	struct iwl_lib_ops iwl2030_lib = {
	.set_hw_params = iwl2000_hw_set_hw_params,
	.nic_config = iwl2000_nic_config,
	.temperature = iwlagn_temperature,
	};

	/*
	* 5000 series
	* ===========
	*/

	/* NIC configuration for 5000 series */
	static const struct iwl_sensitivity_ranges iwl5000_sensitivity = {
	.min_nrg_cck = 100,
	.auto_corr_min_ofdm = 90,
	.auto_corr_min_ofdm_mrc = 170,
	.auto_corr_min_ofdm_x1 = 105,
	.auto_corr_min_ofdm_mrc_x1 = 220,

	.auto_corr_max_ofdm = 120,
	.auto_corr_max_ofdm_mrc = 210,
	.auto_corr_max_ofdm_x1 = 120,
	.auto_corr_max_ofdm_mrc_x1 = 240,

	.auto_corr_min_cck = 125,
	.auto_corr_max_cck = 200,
	.auto_corr_min_cck_mrc = 200,
	.auto_corr_max_cck_mrc = 400,
	.nrg_th_cck = 100,
	.nrg_th_ofdm = 100,

	.barker_corr_th_min = 190,
	.barker_corr_th_min_mrc = 390,
	.nrg_th_cca = 62,
	};

	static struct iwl_sensitivity_ranges iwl5150_sensitivity = {
	.min_nrg_cck = 95,
	.auto_corr_min_ofdm = 90,
	.auto_corr_min_ofdm_mrc = 170,
	.auto_corr_min_ofdm_x1 = 105,
	.auto_corr_min_ofdm_mrc_x1 = 220,

	.auto_corr_max_ofdm = 120,
	.auto_corr_max_ofdm_mrc = 210,
	/* max = min for performance bug in 5150 DSP */
	.auto_corr_max_ofdm_x1 = 105,
	.auto_corr_max_ofdm_mrc_x1 = 220,

	.auto_corr_min_cck = 125,
	.auto_corr_max_cck = 200,
	.auto_corr_min_cck_mrc = 170,
	.auto_corr_max_cck_mrc = 400,
	.nrg_th_cck = 95,
	.nrg_th_ofdm = 95,

	.barker_corr_th_min = 190,
	.barker_corr_th_min_mrc = 390,
	.nrg_th_cca = 62,
	};

	#define IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF (-5)

	static s32 iwl_temp_calib_to_offset(struct iwl_priv *priv)
	{
	u16 temperature, voltage;

	temperature = le16_to_cpu(priv->eeprom_data->kelvin_temperature);
	voltage = le16_to_cpu(priv->eeprom_data->kelvin_voltage);

	/* offset = temp - volt / coeff */
	return (s32)(temperature -
	voltage / IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF);
	}

	static void iwl5150_set_ct_threshold(struct iwl_priv *priv)
	{
	const s32 volt2temp_coef = IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF;
	s32 threshold = (s32)CELSIUS_TO_KELVIN(CT_KILL_THRESHOLD_LEGACY) -
	iwl_temp_calib_to_offset(priv);

	priv->hw_params.ct_kill_threshold = threshold * volt2temp_coef;
	}

	static void iwl5000_set_ct_threshold(struct iwl_priv *priv)
	{
	/* want Celsius */
	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD_LEGACY;
	}

	static void iwl5000_hw_set_hw_params(struct iwl_priv *priv)
	{
	iwl5000_set_ct_threshold(priv);

	/* Set initial sensitivity parameters */
	priv->hw_params.sens = &iwl5000_sensitivity;
	}

	static void iwl5150_hw_set_hw_params(struct iwl_priv *priv)
	{
	iwl5150_set_ct_threshold(priv);

	/* Set initial sensitivity parameters */
	priv->hw_params.sens = &iwl5150_sensitivity;
	}

	static void iwl5150_temperature(struct iwl_priv *priv)
	{
	u32 vt = 0;
	s32 offset = iwl_temp_calib_to_offset(priv);

	vt = le32_to_cpu(priv->statistics.common.temperature);
	vt = vt / IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF + offset;
	/* now vt hold the temperature in Kelvin */
	priv->temperature = KELVIN_TO_CELSIUS(vt);
	iwl_tt_handler(priv);
	}

	static int iwl5000_hw_channel_switch(struct iwl_priv *priv,
	struct ieee80211_channel_switch *ch_switch)
	{
	/*
	* MULTI-FIXME
	* See iwlagn_mac_channel_switch.
	*/
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
	struct iwl5000_channel_switch_cmd cmd;
	u32 switch_time_in_usec, ucode_switch_time;
	u16 ch;
	u32 tsf_low;
	u8 switch_count;
	u16 beacon_interval = le16_to_cpu(ctx->timing.beacon_interval);
	struct ieee80211_vif *vif = ctx->vif;
	struct iwl_host_cmd hcmd = {
	.id = REPLY_CHANNEL_SWITCH,
	.len = { sizeof(cmd), },
	.flags = CMD_SYNC,
	.data = { &cmd, },
	};

	cmd.band = priv->band == IEEE80211_BAND_2GHZ;
	ch = ch_switch->channel->hw_value;
	IWL_DEBUG_11H(priv, "channel switch from %d to %d\n",
	ctx->active.channel, ch);
	cmd.channel = cpu_to_le16(ch);
	cmd.rxon_flags = ctx->staging.flags;
	cmd.rxon_filter_flags = ctx->staging.filter_flags;
	switch_count = ch_switch->count;
	tsf_low = ch_switch->timestamp & 0x0ffffffff;
	/*
	* calculate the ucode channel switch time
	* adding TSF as one of the factor for when to switch
	*/
	if ((priv->ucode_beacon_time > tsf_low) && beacon_interval) {
	if (switch_count > ((priv->ucode_beacon_time - tsf_low) /
	beacon_interval)) {
	switch_count -= (priv->ucode_beacon_time -
	tsf_low) / beacon_interval;
	} else
	switch_count = 0;
	}
	if (switch_count <= 1)
	cmd.switch_time = cpu_to_le32(priv->ucode_beacon_time);
	else {
	switch_time_in_usec =
	vif->bss_conf.beacon_int * switch_count * TIME_UNIT;
	ucode_switch_time = iwl_usecs_to_beacons(priv,
	switch_time_in_usec,
	beacon_interval);
	cmd.switch_time = iwl_add_beacon_time(priv,
	priv->ucode_beacon_time,
	ucode_switch_time,
	beacon_interval);
	}
	IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
	cmd.switch_time);
	cmd.expect_beacon = ch_switch->channel->flags & IEEE80211_CHAN_RADAR;

	return iwl_dvm_send_cmd(priv, &hcmd);
	}

	struct iwl_lib_ops iwl5000_lib = {
	.set_hw_params = iwl5000_hw_set_hw_params,
	.set_channel_switch = iwl5000_hw_channel_switch,
	.temperature = iwlagn_temperature,
	};

	struct iwl_lib_ops iwl5150_lib = {
	.set_hw_params = iwl5150_hw_set_hw_params,
	.set_channel_switch = iwl5000_hw_channel_switch,
	.temperature = iwl5150_temperature,
	};



	/*
	* 6000 series
	* ===========
	*/

	static void iwl6000_set_ct_threshold(struct iwl_priv *priv)
	{
	/* want Celsius */
	priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD;
	priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
	}

	/* NIC configuration for 6000 series */
	static void iwl6000_nic_config(struct iwl_priv *priv)
	{
	switch (priv->cfg->device_family) {
	case IWL_DEVICE_FAMILY_6005:
	case IWL_DEVICE_FAMILY_6030:
	case IWL_DEVICE_FAMILY_6000:
	break;
	case IWL_DEVICE_FAMILY_6000i:
	/* 2x2 IPA phy type */
	iwl_write32(priv->trans, CSR_GP_DRIVER_REG,
	CSR_GP_DRIVER_REG_BIT_RADIO_SKU_2x2_IPA);
	break;
	case IWL_DEVICE_FAMILY_6050:
	/* Indicate calibration version to uCode. */
	if (priv->eeprom_data->calib_version >= 6)
	iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
	CSR_GP_DRIVER_REG_BIT_CALIB_VERSION6);
	break;
	case IWL_DEVICE_FAMILY_6150:
	/* Indicate calibration version to uCode. */
	if (priv->eeprom_data->calib_version >= 6)
	iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
	CSR_GP_DRIVER_REG_BIT_CALIB_VERSION6);
	iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
	CSR_GP_DRIVER_REG_BIT_6050_1x2);
	break;
	default:
	WARN_ON(1);
	}
	}

	static const struct iwl_sensitivity_ranges iwl6000_sensitivity = {
	.min_nrg_cck = 110,
	.auto_corr_min_ofdm = 80,
	.auto_corr_min_ofdm_mrc = 128,
	.auto_corr_min_ofdm_x1 = 105,
	.auto_corr_min_ofdm_mrc_x1 = 192,

	.auto_corr_max_ofdm = 145,
	.auto_corr_max_ofdm_mrc = 232,
	.auto_corr_max_ofdm_x1 = 110,
	.auto_corr_max_ofdm_mrc_x1 = 232,

	.auto_corr_min_cck = 125,
	.auto_corr_max_cck = 175,
	.auto_corr_min_cck_mrc = 160,
	.auto_corr_max_cck_mrc = 310,
	.nrg_th_cck = 110,
	.nrg_th_ofdm = 110,

	.barker_corr_th_min = 190,
	.barker_corr_th_min_mrc = 336,
	.nrg_th_cca = 62,
	};

	static void iwl6000_hw_set_hw_params(struct iwl_priv *priv)
	{
	iwl6000_set_ct_threshold(priv);

	/* Set initial sensitivity parameters */
	priv->hw_params.sens = &iwl6000_sensitivity;

	}

	static int iwl6000_hw_channel_switch(struct iwl_priv *priv,
	struct ieee80211_channel_switch *ch_switch)
	{
	/*
	* MULTI-FIXME
	* See iwlagn_mac_channel_switch.
	*/
	struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
	struct iwl6000_channel_switch_cmd *cmd;
	u32 switch_time_in_usec, ucode_switch_time;
	u16 ch;
	u32 tsf_low;
	u8 switch_count;
	u16 beacon_interval = le16_to_cpu(ctx->timing.beacon_interval);
	struct ieee80211_vif *vif = ctx->vif;
	struct iwl_host_cmd hcmd = {
	.id = REPLY_CHANNEL_SWITCH,
	.len = { sizeof(*cmd), },
	.flags = CMD_SYNC,
	.dataflags[0] = IWL_HCMD_DFL_NOCOPY,
	};
	int err;

	cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
	if (!cmd)
	return -ENOMEM;

	hcmd.data[0] = cmd;

	cmd->band = priv->band == IEEE80211_BAND_2GHZ;
	ch = ch_switch->channel->hw_value;
	IWL_DEBUG_11H(priv, "channel switch from %u to %u\n",
	ctx->active.channel, ch);
	cmd->channel = cpu_to_le16(ch);
	cmd->rxon_flags = ctx->staging.flags;
	cmd->rxon_filter_flags = ctx->staging.filter_flags;
	switch_count = ch_switch->count;
	tsf_low = ch_switch->timestamp & 0x0ffffffff;
	/*
	* calculate the ucode channel switch time
	* adding TSF as one of the factor for when to switch
	*/
	if ((priv->ucode_beacon_time > tsf_low) && beacon_interval) {
	if (switch_count > ((priv->ucode_beacon_time - tsf_low) /
	beacon_interval)) {
	switch_count -= (priv->ucode_beacon_time -
	tsf_low) / beacon_interval;
	} else
	switch_count = 0;
	}
	if (switch_count <= 1)
	cmd->switch_time = cpu_to_le32(priv->ucode_beacon_time);
	else {
	switch_time_in_usec =
	vif->bss_conf.beacon_int * switch_count * TIME_UNIT;
	ucode_switch_time = iwl_usecs_to_beacons(priv,
	switch_time_in_usec,
	beacon_interval);
	cmd->switch_time = iwl_add_beacon_time(priv,
	priv->ucode_beacon_time,
	ucode_switch_time,
	beacon_interval);
	}
	IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
	cmd->switch_time);
	cmd->expect_beacon = ch_switch->channel->flags & IEEE80211_CHAN_RADAR;

	err = iwl_dvm_send_cmd(priv, &hcmd);
	kfree(cmd);
	return err;
	}

	struct iwl_lib_ops iwl6000_lib = {
	.set_hw_params = iwl6000_hw_set_hw_params,
	.set_channel_switch = iwl6000_hw_channel_switch,
	.nic_config = iwl6000_nic_config,
	.temperature = iwlagn_temperature,
	};

	struct iwl_lib_ops iwl6030_lib = {
	.set_hw_params = iwl6000_hw_set_hw_params,
	.set_channel_switch = iwl6000_hw_channel_switch,
	.nic_config = iwl6000_nic_config,
	.temperature = iwlagn_temperature,
	};