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