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