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