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