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

   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  */
  42 static 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 */
  50 static 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  */
  64 static 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  */
  75 static 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  */
  87 static 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  */
 109 static __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
 133 static 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
 157 static 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
 165 const 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
 180 static 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 */
 188 static 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
 194 static 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
 218 static 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
 226 const 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
 239 const 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
 253 static 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
 263 const 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 */
 284 static 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
 308 static 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
 335 static 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
 347 static 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
 356 static 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
 362 static 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
 370 static 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
 378 static 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
 390 static 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
 453 const 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
 462 const 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
 479 static 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 */
 487 static 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
 518 static 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
 542 static 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
 551 static 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
 623 const 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
 634 const 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
 646 const 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
 657 static 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
 666 const 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 };