drivers/net/wireless/iwlwifi/dvm/devices.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2008 - 2013 Intel Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  * The full GNU General Public License is included in this distribution in the
  19  * file called LICENSE.
  20  *
  21  * Contact Information:
  22  *  Intel Linux Wireless <ilw@linux.intel.com>
  23  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  24  *
  25  *****************************************************************************/
  26
  27 /*
  28  * DVM device-specific data & functions
  29  */
  30 #include "iwl-io.h"
  31 #include "iwl-prph.h"
  32 #include "iwl-eeprom-parse.h"
  33
  34 #include "agn.h"
  35 #include "dev.h"
  36 #include "commands.h"
  37
  38
  39 /*
  40  * 1000 series
  41  * ===========
  42  */
  43
  44 /*
  45  * For 1000, use advance thermal throttling critical temperature threshold,
  46  * but legacy thermal management implementation for now.
  47  * This is for the reason of 1000 uCode using advance thermal throttling API
  48  * but not implement ct_kill_exit based on ct_kill exit temperature
  49  * so the thermal throttling will still based on legacy thermal throttling
  50  * management.
  51  * The code here need to be modified once 1000 uCode has the advanced thermal
  52  * throttling algorithm in place
  53  */
  54 static void iwl1000_set_ct_threshold(struct iwl_priv *priv)
  55 {
  56         /* want Celsius */
  57         priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD_LEGACY;
  58         priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
  59 }
  60
  61 /* NIC configuration for 1000 series */
  62 static void iwl1000_nic_config(struct iwl_priv *priv)
  63 {
  64         /* Setting digital SVR for 1000 card to 1.32V */
  65         /* locking is acquired in iwl_set_bits_mask_prph() function */
  66         iwl_set_bits_mask_prph(priv->trans, APMG_DIGITAL_SVR_REG,
  67                                 APMG_SVR_DIGITAL_VOLTAGE_1_32,
  68                                 ~APMG_SVR_VOLTAGE_CONFIG_BIT_MSK);
  69 }
  70
  71 /**
  72  * iwl_beacon_time_mask_low - mask of lower 32 bit of beacon time
  73  * @priv -- pointer to iwl_priv data structure
  74  * @tsf_bits -- number of bits need to shift for masking)
  75  */
  76 static inline u32 iwl_beacon_time_mask_low(struct iwl_priv *priv,
  77                                            u16 tsf_bits)
  78 {
  79         return (1 << tsf_bits) - 1;
  80 }
  81
  82 /**
  83  * iwl_beacon_time_mask_high - mask of higher 32 bit of beacon time
  84  * @priv -- pointer to iwl_priv data structure
  85  * @tsf_bits -- number of bits need to shift for masking)
  86  */
  87 static inline u32 iwl_beacon_time_mask_high(struct iwl_priv *priv,
  88                                             u16 tsf_bits)
  89 {
  90         return ((1 << (32 - tsf_bits)) - 1) << tsf_bits;
  91 }
  92
  93 /*
  94  * extended beacon time format
  95  * time in usec will be changed into a 32-bit value in extended:internal format
  96  * the extended part is the beacon counts
  97  * the internal part is the time in usec within one beacon interval
  98  */
  99 static u32 iwl_usecs_to_beacons(struct iwl_priv *priv, u32 usec,
 100                                 u32 beacon_interval)
 101 {
 102         u32 quot;
 103         u32 rem;
 104         u32 interval = beacon_interval * TIME_UNIT;
 105
 106         if (!interval || !usec)
 107                 return 0;
 108
 109         quot = (usec / interval) &
 110                 (iwl_beacon_time_mask_high(priv, IWLAGN_EXT_BEACON_TIME_POS) >>
 111                 IWLAGN_EXT_BEACON_TIME_POS);
 112         rem = (usec % interval) & iwl_beacon_time_mask_low(priv,
 113                                    IWLAGN_EXT_BEACON_TIME_POS);
 114
 115         return (quot << IWLAGN_EXT_BEACON_TIME_POS) + rem;
 116 }
 117
 118 /* base is usually what we get from ucode with each received frame,
 119  * the same as HW timer counter counting down
 120  */
 121 static __le32 iwl_add_beacon_time(struct iwl_priv *priv, u32 base,
 122                            u32 addon, u32 beacon_interval)
 123 {
 124         u32 base_low = base & iwl_beacon_time_mask_low(priv,
 125                                 IWLAGN_EXT_BEACON_TIME_POS);
 126         u32 addon_low = addon & iwl_beacon_time_mask_low(priv,
 127                                 IWLAGN_EXT_BEACON_TIME_POS);
 128         u32 interval = beacon_interval * TIME_UNIT;
 129         u32 res = (base & iwl_beacon_time_mask_high(priv,
 130                                 IWLAGN_EXT_BEACON_TIME_POS)) +
 131                                 (addon & iwl_beacon_time_mask_high(priv,
 132                                 IWLAGN_EXT_BEACON_TIME_POS));
 133
 134         if (base_low > addon_low)
 135                 res += base_low - addon_low;
 136         else if (base_low < addon_low) {
 137                 res += interval + base_low - addon_low;
 138                 res += (1 << IWLAGN_EXT_BEACON_TIME_POS);
 139         } else
 140                 res += (1 << IWLAGN_EXT_BEACON_TIME_POS);
 141
 142         return cpu_to_le32(res);
 143 }
 144
 145 static const struct iwl_sensitivity_ranges iwl1000_sensitivity = {
 146         .min_nrg_cck = 95,
 147         .auto_corr_min_ofdm = 90,
 148         .auto_corr_min_ofdm_mrc = 170,
 149         .auto_corr_min_ofdm_x1 = 120,
 150         .auto_corr_min_ofdm_mrc_x1 = 240,
 151
 152         .auto_corr_max_ofdm = 120,
 153         .auto_corr_max_ofdm_mrc = 210,
 154         .auto_corr_max_ofdm_x1 = 155,
 155         .auto_corr_max_ofdm_mrc_x1 = 290,
 156
 157         .auto_corr_min_cck = 125,
 158         .auto_corr_max_cck = 200,
 159         .auto_corr_min_cck_mrc = 170,
 160         .auto_corr_max_cck_mrc = 400,
 161         .nrg_th_cck = 95,
 162         .nrg_th_ofdm = 95,
 163
 164         .barker_corr_th_min = 190,
 165         .barker_corr_th_min_mrc = 390,
 166         .nrg_th_cca = 62,
 167 };
 168
 169 static void iwl1000_hw_set_hw_params(struct iwl_priv *priv)
 170 {
 171         iwl1000_set_ct_threshold(priv);
 172
 173         /* Set initial sensitivity parameters */
 174         priv->hw_params.sens = &iwl1000_sensitivity;
 175 }
 176
 177 const struct iwl_dvm_cfg iwl_dvm_1000_cfg = {
 178         .set_hw_params = iwl1000_hw_set_hw_params,
 179         .nic_config = iwl1000_nic_config,
 180         .temperature = iwlagn_temperature,
 181         .support_ct_kill_exit = true,
 182         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_EXT_LONG_THRESHOLD_DEF,
 183         .chain_noise_scale = 1000,
 184 };
 185
 186
 187 /*
 188  * 2000 series
 189  * ===========
 190  */
 191
 192 static void iwl2000_set_ct_threshold(struct iwl_priv *priv)
 193 {
 194         /* want Celsius */
 195         priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD;
 196         priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
 197 }
 198
 199 /* NIC configuration for 2000 series */
 200 static void iwl2000_nic_config(struct iwl_priv *priv)
 201 {
 202         iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 203                     CSR_GP_DRIVER_REG_BIT_RADIO_IQ_INVER);
 204 }
 205
 206 static const struct iwl_sensitivity_ranges iwl2000_sensitivity = {
 207         .min_nrg_cck = 97,
 208         .auto_corr_min_ofdm = 80,
 209         .auto_corr_min_ofdm_mrc = 128,
 210         .auto_corr_min_ofdm_x1 = 105,
 211         .auto_corr_min_ofdm_mrc_x1 = 192,
 212
 213         .auto_corr_max_ofdm = 145,
 214         .auto_corr_max_ofdm_mrc = 232,
 215         .auto_corr_max_ofdm_x1 = 110,
 216         .auto_corr_max_ofdm_mrc_x1 = 232,
 217
 218         .auto_corr_min_cck = 125,
 219         .auto_corr_max_cck = 175,
 220         .auto_corr_min_cck_mrc = 160,
 221         .auto_corr_max_cck_mrc = 310,
 222         .nrg_th_cck = 97,
 223         .nrg_th_ofdm = 100,
 224
 225         .barker_corr_th_min = 190,
 226         .barker_corr_th_min_mrc = 390,
 227         .nrg_th_cca = 62,
 228 };
 229
 230 static void iwl2000_hw_set_hw_params(struct iwl_priv *priv)
 231 {
 232         iwl2000_set_ct_threshold(priv);
 233
 234         /* Set initial sensitivity parameters */
 235         priv->hw_params.sens = &iwl2000_sensitivity;
 236 }
 237
 238 const struct iwl_dvm_cfg iwl_dvm_2000_cfg = {
 239         .set_hw_params = iwl2000_hw_set_hw_params,
 240         .nic_config = iwl2000_nic_config,
 241         .temperature = iwlagn_temperature,
 242         .adv_thermal_throttle = true,
 243         .support_ct_kill_exit = true,
 244         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 245         .chain_noise_scale = 1000,
 246         .hd_v2 = true,
 247         .need_temp_offset_calib = true,
 248         .temp_offset_v2 = true,
 249 };
 250
 251 const struct iwl_dvm_cfg iwl_dvm_105_cfg = {
 252         .set_hw_params = iwl2000_hw_set_hw_params,
 253         .nic_config = iwl2000_nic_config,
 254         .temperature = iwlagn_temperature,
 255         .adv_thermal_throttle = true,
 256         .support_ct_kill_exit = true,
 257         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 258         .chain_noise_scale = 1000,
 259         .hd_v2 = true,
 260         .need_temp_offset_calib = true,
 261         .temp_offset_v2 = true,
 262         .adv_pm = true,
 263 };
 264
 265 static const struct iwl_dvm_bt_params iwl2030_bt_params = {
 266         /* Due to bluetooth, we transmit 2.4 GHz probes only on antenna A */
 267         .advanced_bt_coexist = true,
 268         .agg_time_limit = BT_AGG_THRESHOLD_DEF,
 269         .bt_init_traffic_load = IWL_BT_COEX_TRAFFIC_LOAD_NONE,
 270         .bt_prio_boost = IWLAGN_BT_PRIO_BOOST_DEFAULT32,
 271         .bt_sco_disable = true,
 272         .bt_session_2 = true,
 273 };
 274
 275 const struct iwl_dvm_cfg iwl_dvm_2030_cfg = {
 276         .set_hw_params = iwl2000_hw_set_hw_params,
 277         .nic_config = iwl2000_nic_config,
 278         .temperature = iwlagn_temperature,
 279         .adv_thermal_throttle = true,
 280         .support_ct_kill_exit = true,
 281         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 282         .chain_noise_scale = 1000,
 283         .hd_v2 = true,
 284         .bt_params = &iwl2030_bt_params,
 285         .need_temp_offset_calib = true,
 286         .temp_offset_v2 = true,
 287         .adv_pm = true,
 288 };
 289
 290 /*
 291  * 5000 series
 292  * ===========
 293  */
 294
 295 /* NIC configuration for 5000 series */
 296 static const struct iwl_sensitivity_ranges iwl5000_sensitivity = {
 297         .min_nrg_cck = 100,
 298         .auto_corr_min_ofdm = 90,
 299         .auto_corr_min_ofdm_mrc = 170,
 300         .auto_corr_min_ofdm_x1 = 105,
 301         .auto_corr_min_ofdm_mrc_x1 = 220,
 302
 303         .auto_corr_max_ofdm = 120,
 304         .auto_corr_max_ofdm_mrc = 210,
 305         .auto_corr_max_ofdm_x1 = 120,
 306         .auto_corr_max_ofdm_mrc_x1 = 240,
 307
 308         .auto_corr_min_cck = 125,
 309         .auto_corr_max_cck = 200,
 310         .auto_corr_min_cck_mrc = 200,
 311         .auto_corr_max_cck_mrc = 400,
 312         .nrg_th_cck = 100,
 313         .nrg_th_ofdm = 100,
 314
 315         .barker_corr_th_min = 190,
 316         .barker_corr_th_min_mrc = 390,
 317         .nrg_th_cca = 62,
 318 };
 319
 320 static struct iwl_sensitivity_ranges iwl5150_sensitivity = {
 321         .min_nrg_cck = 95,
 322         .auto_corr_min_ofdm = 90,
 323         .auto_corr_min_ofdm_mrc = 170,
 324         .auto_corr_min_ofdm_x1 = 105,
 325         .auto_corr_min_ofdm_mrc_x1 = 220,
 326
 327         .auto_corr_max_ofdm = 120,
 328         .auto_corr_max_ofdm_mrc = 210,
 329         /* max = min for performance bug in 5150 DSP */
 330         .auto_corr_max_ofdm_x1 = 105,
 331         .auto_corr_max_ofdm_mrc_x1 = 220,
 332
 333         .auto_corr_min_cck = 125,
 334         .auto_corr_max_cck = 200,
 335         .auto_corr_min_cck_mrc = 170,
 336         .auto_corr_max_cck_mrc = 400,
 337         .nrg_th_cck = 95,
 338         .nrg_th_ofdm = 95,
 339
 340         .barker_corr_th_min = 190,
 341         .barker_corr_th_min_mrc = 390,
 342         .nrg_th_cca = 62,
 343 };
 344
 345 #define IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF   (-5)
 346
 347 static s32 iwl_temp_calib_to_offset(struct iwl_priv *priv)
 348 {
 349         u16 temperature, voltage;
 350
 351         temperature = le16_to_cpu(priv->nvm_data->kelvin_temperature);
 352         voltage = le16_to_cpu(priv->nvm_data->kelvin_voltage);
 353
 354         /* offset = temp - volt / coeff */
 355         return (s32)(temperature -
 356                         voltage / IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF);
 357 }
 358
 359 static void iwl5150_set_ct_threshold(struct iwl_priv *priv)
 360 {
 361         const s32 volt2temp_coef = IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF;
 362         s32 threshold = (s32)CELSIUS_TO_KELVIN(CT_KILL_THRESHOLD_LEGACY) -
 363                         iwl_temp_calib_to_offset(priv);
 364
 365         priv->hw_params.ct_kill_threshold = threshold * volt2temp_coef;
 366 }
 367
 368 static void iwl5000_set_ct_threshold(struct iwl_priv *priv)
 369 {
 370         /* want Celsius */
 371         priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD_LEGACY;
 372 }
 373
 374 static void iwl5000_hw_set_hw_params(struct iwl_priv *priv)
 375 {
 376         iwl5000_set_ct_threshold(priv);
 377
 378         /* Set initial sensitivity parameters */
 379         priv->hw_params.sens = &iwl5000_sensitivity;
 380 }
 381
 382 static void iwl5150_hw_set_hw_params(struct iwl_priv *priv)
 383 {
 384         iwl5150_set_ct_threshold(priv);
 385
 386         /* Set initial sensitivity parameters */
 387         priv->hw_params.sens = &iwl5150_sensitivity;
 388 }
 389
 390 static void iwl5150_temperature(struct iwl_priv *priv)
 391 {
 392         u32 vt = 0;
 393         s32 offset =  iwl_temp_calib_to_offset(priv);
 394
 395         vt = le32_to_cpu(priv->statistics.common.temperature);
 396         vt = vt / IWL_5150_VOLTAGE_TO_TEMPERATURE_COEFF + offset;
 397         /* now vt hold the temperature in Kelvin */
 398         priv->temperature = KELVIN_TO_CELSIUS(vt);
 399         iwl_tt_handler(priv);
 400 }
 401
 402 static int iwl5000_hw_channel_switch(struct iwl_priv *priv,
 403                                      struct ieee80211_channel_switch *ch_switch)
 404 {
 405         /*
 406          * MULTI-FIXME
 407          * See iwlagn_mac_channel_switch.
 408          */
 409         struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
 410         struct iwl5000_channel_switch_cmd cmd;
 411         u32 switch_time_in_usec, ucode_switch_time;
 412         u16 ch;
 413         u32 tsf_low;
 414         u8 switch_count;
 415         u16 beacon_interval = le16_to_cpu(ctx->timing.beacon_interval);
 416         struct ieee80211_vif *vif = ctx->vif;
 417         struct iwl_host_cmd hcmd = {
 418                 .id = REPLY_CHANNEL_SWITCH,
 419                 .len = { sizeof(cmd), },
 420                 .flags = CMD_SYNC,
 421                 .data = { &cmd, },
 422         };
 423
 424         cmd.band = priv->band == IEEE80211_BAND_2GHZ;
 425         ch = ch_switch->chandef.chan->hw_value;
 426         IWL_DEBUG_11H(priv, "channel switch from %d to %d\n",
 427                       ctx->active.channel, ch);
 428         cmd.channel = cpu_to_le16(ch);
 429         cmd.rxon_flags = ctx->staging.flags;
 430         cmd.rxon_filter_flags = ctx->staging.filter_flags;
 431         switch_count = ch_switch->count;
 432         tsf_low = ch_switch->timestamp & 0x0ffffffff;
 433         /*
 434          * calculate the ucode channel switch time
 435          * adding TSF as one of the factor for when to switch
 436          */
 437         if ((priv->ucode_beacon_time > tsf_low) && beacon_interval) {
 438                 if (switch_count > ((priv->ucode_beacon_time - tsf_low) /
 439                     beacon_interval)) {
 440                         switch_count -= (priv->ucode_beacon_time -
 441                                 tsf_low) / beacon_interval;
 442                 } else
 443                         switch_count = 0;
 444         }
 445         if (switch_count <= 1)
 446                 cmd.switch_time = cpu_to_le32(priv->ucode_beacon_time);
 447         else {
 448                 switch_time_in_usec =
 449                         vif->bss_conf.beacon_int * switch_count * TIME_UNIT;
 450                 ucode_switch_time = iwl_usecs_to_beacons(priv,
 451                                                          switch_time_in_usec,
 452                                                          beacon_interval);
 453                 cmd.switch_time = iwl_add_beacon_time(priv,
 454                                                       priv->ucode_beacon_time,
 455                                                       ucode_switch_time,
 456                                                       beacon_interval);
 457         }
 458         IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
 459                       cmd.switch_time);
 460         cmd.expect_beacon =
 461                 ch_switch->chandef.chan->flags & IEEE80211_CHAN_RADAR;
 462
 463         return iwl_dvm_send_cmd(priv, &hcmd);
 464 }
 465
 466 const struct iwl_dvm_cfg iwl_dvm_5000_cfg = {
 467         .set_hw_params = iwl5000_hw_set_hw_params,
 468         .set_channel_switch = iwl5000_hw_channel_switch,
 469         .temperature = iwlagn_temperature,
 470         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_LONG_THRESHOLD_DEF,
 471         .chain_noise_scale = 1000,
 472         .no_idle_support = true,
 473 };
 474
 475 const struct iwl_dvm_cfg iwl_dvm_5150_cfg = {
 476         .set_hw_params = iwl5150_hw_set_hw_params,
 477         .set_channel_switch = iwl5000_hw_channel_switch,
 478         .temperature = iwl5150_temperature,
 479         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_LONG_THRESHOLD_DEF,
 480         .chain_noise_scale = 1000,
 481         .no_idle_support = true,
 482         .no_xtal_calib = true,
 483 };
 484
 485
 486
 487 /*
 488  * 6000 series
 489  * ===========
 490  */
 491
 492 static void iwl6000_set_ct_threshold(struct iwl_priv *priv)
 493 {
 494         /* want Celsius */
 495         priv->hw_params.ct_kill_threshold = CT_KILL_THRESHOLD;
 496         priv->hw_params.ct_kill_exit_threshold = CT_KILL_EXIT_THRESHOLD;
 497 }
 498
 499 /* NIC configuration for 6000 series */
 500 static void iwl6000_nic_config(struct iwl_priv *priv)
 501 {
 502         switch (priv->cfg->device_family) {
 503         case IWL_DEVICE_FAMILY_6005:
 504         case IWL_DEVICE_FAMILY_6030:
 505         case IWL_DEVICE_FAMILY_6000:
 506                 break;
 507         case IWL_DEVICE_FAMILY_6000i:
 508                 /* 2x2 IPA phy type */
 509                 iwl_write32(priv->trans, CSR_GP_DRIVER_REG,
 510                              CSR_GP_DRIVER_REG_BIT_RADIO_SKU_2x2_IPA);
 511                 break;
 512         case IWL_DEVICE_FAMILY_6050:
 513                 /* Indicate calibration version to uCode. */
 514                 if (priv->nvm_data->calib_version >= 6)
 515                         iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 516                                         CSR_GP_DRIVER_REG_BIT_CALIB_VERSION6);
 517                 break;
 518         case IWL_DEVICE_FAMILY_6150:
 519                 /* Indicate calibration version to uCode. */
 520                 if (priv->nvm_data->calib_version >= 6)
 521                         iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 522                                         CSR_GP_DRIVER_REG_BIT_CALIB_VERSION6);
 523                 iwl_set_bit(priv->trans, CSR_GP_DRIVER_REG,
 524                             CSR_GP_DRIVER_REG_BIT_6050_1x2);
 525                 break;
 526         default:
 527                 WARN_ON(1);
 528         }
 529 }
 530
 531 static const struct iwl_sensitivity_ranges iwl6000_sensitivity = {
 532         .min_nrg_cck = 110,
 533         .auto_corr_min_ofdm = 80,
 534         .auto_corr_min_ofdm_mrc = 128,
 535         .auto_corr_min_ofdm_x1 = 105,
 536         .auto_corr_min_ofdm_mrc_x1 = 192,
 537
 538         .auto_corr_max_ofdm = 145,
 539         .auto_corr_max_ofdm_mrc = 232,
 540         .auto_corr_max_ofdm_x1 = 110,
 541         .auto_corr_max_ofdm_mrc_x1 = 232,
 542
 543         .auto_corr_min_cck = 125,
 544         .auto_corr_max_cck = 175,
 545         .auto_corr_min_cck_mrc = 160,
 546         .auto_corr_max_cck_mrc = 310,
 547         .nrg_th_cck = 110,
 548         .nrg_th_ofdm = 110,
 549
 550         .barker_corr_th_min = 190,
 551         .barker_corr_th_min_mrc = 336,
 552         .nrg_th_cca = 62,
 553 };
 554
 555 static void iwl6000_hw_set_hw_params(struct iwl_priv *priv)
 556 {
 557         iwl6000_set_ct_threshold(priv);
 558
 559         /* Set initial sensitivity parameters */
 560         priv->hw_params.sens = &iwl6000_sensitivity;
 561
 562 }
 563
 564 static int iwl6000_hw_channel_switch(struct iwl_priv *priv,
 565                                      struct ieee80211_channel_switch *ch_switch)
 566 {
 567         /*
 568          * MULTI-FIXME
 569          * See iwlagn_mac_channel_switch.
 570          */
 571         struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
 572         struct iwl6000_channel_switch_cmd *cmd;
 573         u32 switch_time_in_usec, ucode_switch_time;
 574         u16 ch;
 575         u32 tsf_low;
 576         u8 switch_count;
 577         u16 beacon_interval = le16_to_cpu(ctx->timing.beacon_interval);
 578         struct ieee80211_vif *vif = ctx->vif;
 579         struct iwl_host_cmd hcmd = {
 580                 .id = REPLY_CHANNEL_SWITCH,
 581                 .len = { sizeof(*cmd), },
 582                 .flags = CMD_SYNC,
 583                 .dataflags[0] = IWL_HCMD_DFL_NOCOPY,
 584         };
 585         int err;
 586
 587         cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
 588         if (!cmd)
 589                 return -ENOMEM;
 590
 591         hcmd.data[0] = cmd;
 592
 593         cmd->band = priv->band == IEEE80211_BAND_2GHZ;
 594         ch = ch_switch->chandef.chan->hw_value;
 595         IWL_DEBUG_11H(priv, "channel switch from %u to %u\n",
 596                       ctx->active.channel, ch);
 597         cmd->channel = cpu_to_le16(ch);
 598         cmd->rxon_flags = ctx->staging.flags;
 599         cmd->rxon_filter_flags = ctx->staging.filter_flags;
 600         switch_count = ch_switch->count;
 601         tsf_low = ch_switch->timestamp & 0x0ffffffff;
 602         /*
 603          * calculate the ucode channel switch time
 604          * adding TSF as one of the factor for when to switch
 605          */
 606         if ((priv->ucode_beacon_time > tsf_low) && beacon_interval) {
 607                 if (switch_count > ((priv->ucode_beacon_time - tsf_low) /
 608                     beacon_interval)) {
 609                         switch_count -= (priv->ucode_beacon_time -
 610                                 tsf_low) / beacon_interval;
 611                 } else
 612                         switch_count = 0;
 613         }
 614         if (switch_count <= 1)
 615                 cmd->switch_time = cpu_to_le32(priv->ucode_beacon_time);
 616         else {
 617                 switch_time_in_usec =
 618                         vif->bss_conf.beacon_int * switch_count * TIME_UNIT;
 619                 ucode_switch_time = iwl_usecs_to_beacons(priv,
 620                                                          switch_time_in_usec,
 621                                                          beacon_interval);
 622                 cmd->switch_time = iwl_add_beacon_time(priv,
 623                                                        priv->ucode_beacon_time,
 624                                                        ucode_switch_time,
 625                                                        beacon_interval);
 626         }
 627         IWL_DEBUG_11H(priv, "uCode time for the switch is 0x%x\n",
 628                       cmd->switch_time);
 629         cmd->expect_beacon =
 630                 ch_switch->chandef.chan->flags & IEEE80211_CHAN_RADAR;
 631
 632         err = iwl_dvm_send_cmd(priv, &hcmd);
 633         kfree(cmd);
 634         return err;
 635 }
 636
 637 const struct iwl_dvm_cfg iwl_dvm_6000_cfg = {
 638         .set_hw_params = iwl6000_hw_set_hw_params,
 639         .set_channel_switch = iwl6000_hw_channel_switch,
 640         .nic_config = iwl6000_nic_config,
 641         .temperature = iwlagn_temperature,
 642         .adv_thermal_throttle = true,
 643         .support_ct_kill_exit = true,
 644         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 645         .chain_noise_scale = 1000,
 646 };
 647
 648 const struct iwl_dvm_cfg iwl_dvm_6005_cfg = {
 649         .set_hw_params = iwl6000_hw_set_hw_params,
 650         .set_channel_switch = iwl6000_hw_channel_switch,
 651         .nic_config = iwl6000_nic_config,
 652         .temperature = iwlagn_temperature,
 653         .adv_thermal_throttle = true,
 654         .support_ct_kill_exit = true,
 655         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 656         .chain_noise_scale = 1000,
 657         .need_temp_offset_calib = true,
 658 };
 659
 660 const struct iwl_dvm_cfg iwl_dvm_6050_cfg = {
 661         .set_hw_params = iwl6000_hw_set_hw_params,
 662         .set_channel_switch = iwl6000_hw_channel_switch,
 663         .nic_config = iwl6000_nic_config,
 664         .temperature = iwlagn_temperature,
 665         .adv_thermal_throttle = true,
 666         .support_ct_kill_exit = true,
 667         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 668         .chain_noise_scale = 1500,
 669 };
 670
 671 static const struct iwl_dvm_bt_params iwl6000_bt_params = {
 672         /* Due to bluetooth, we transmit 2.4 GHz probes only on antenna A */
 673         .advanced_bt_coexist = true,
 674         .agg_time_limit = BT_AGG_THRESHOLD_DEF,
 675         .bt_init_traffic_load = IWL_BT_COEX_TRAFFIC_LOAD_NONE,
 676         .bt_prio_boost = IWLAGN_BT_PRIO_BOOST_DEFAULT,
 677         .bt_sco_disable = true,
 678 };
 679
 680 const struct iwl_dvm_cfg iwl_dvm_6030_cfg = {
 681         .set_hw_params = iwl6000_hw_set_hw_params,
 682         .set_channel_switch = iwl6000_hw_channel_switch,
 683         .nic_config = iwl6000_nic_config,
 684         .temperature = iwlagn_temperature,
 685         .adv_thermal_throttle = true,
 686         .support_ct_kill_exit = true,
 687         .plcp_delta_threshold = IWL_MAX_PLCP_ERR_THRESHOLD_DEF,
 688         .chain_noise_scale = 1000,
 689         .bt_params = &iwl6000_bt_params,
 690         .need_temp_offset_calib = true,
 691         .adv_pm = true,
 692 };