1 files changed, 45 insertions, 141 deletions

diff --git a/drivers/net/wireless/iwlwifi/iwl4965-base.c b/drivers/net/wireless/iwlwifi/iwl4965-base.c
index c2366c2d23b..2c706395e0a 100644
--- a/drivers/net/wireless/iwlwifi/iwl4965-base.c
+++ b/drivers/net/wireless/iwlwifi/iwl4965-base.c
@@ -2111,7 +2111,7 @@ static void iwl4965_activate_qos(struct iwl4965_priv *priv, u8 force)
                         QOS_PARAM_FLG_UPDATE_EDCA_MSK;
 
 #ifdef CONFIG_IWL4965_HT
-        if (priv->is_ht_enabled && priv->current_assoc_ht.is_ht)
+        if (priv->current_ht_config.is_ht)
                 priv->qos_data.def_qos_parm.qos_flags |= QOS_PARAM_FLG_TGN_MSK;
 #endif /* CONFIG_IWL4965_HT */
 
@@ -7304,13 +7304,8 @@ static void iwl4965_bg_post_associate(struct work_struct *data)
         priv->staging_rxon.filter_flags |= RXON_FILTER_ASSOC_MSK;
 
 #ifdef CONFIG_IWL4965_HT
-        if (priv->is_ht_enabled && priv->current_assoc_ht.is_ht)
-                iwl4965_set_rxon_ht(priv, &priv->current_assoc_ht);
-        else {
-                priv->active_rate_ht[0] = 0;
-                priv->active_rate_ht[1] = 0;
-                priv->current_channel_width = IWL_CHANNEL_WIDTH_20MHZ;
-        }
+        if (priv->current_ht_config.is_ht)
+                iwl4965_set_rxon_ht(priv, &priv->current_ht_config);
 #endif /* CONFIG_IWL4965_HT*/
         iwl4965_set_rxon_chain(priv);
         priv->staging_rxon.assoc_id = cpu_to_le16(priv->assoc_id);
@@ -8112,7 +8107,7 @@ static void iwl4965_mac_reset_tsf(struct ieee80211_hw *hw)
         priv->lq_mngr.lq_ready = 0;
 #ifdef CONFIG_IWL4965_HT
         spin_lock_irqsave(&priv->lock, flags);
-        memset(&priv->current_assoc_ht, 0, sizeof(struct sta_ht_info));
+        memset(&priv->current_ht_config, 0, sizeof(struct iwl_ht_info));
         spin_unlock_irqrestore(&priv->lock, flags);
 #ifdef CONFIG_IWL4965_HT_AGG
 /*      if (priv->lq_mngr.agg_ctrl.granted_ba)
@@ -8232,132 +8227,61 @@ static int iwl4965_mac_beacon_update(struct ieee80211_hw *hw, struct sk_buff *sk
 }
 
 #ifdef CONFIG_IWL4965_HT
-union ht_cap_info {
-        struct {
-                u16 advanced_coding_cap         :1;
-                u16 supported_chan_width_set    :1;
-                u16 mimo_power_save_mode        :2;
-                u16 green_field                 :1;
-                u16 short_GI20                  :1;
-                u16 short_GI40                  :1;
-                u16 tx_stbc                     :1;
-                u16 rx_stbc                     :1;
-                u16 beam_forming                :1;
-                u16 delayed_ba                  :1;
-                u16 maximal_amsdu_size          :1;
-                u16 cck_mode_at_40MHz           :1;
-                u16 psmp_support                :1;
-                u16 stbc_ctrl_frame_support     :1;
-                u16 sig_txop_protection_support :1;
-        };
-        u16 val;
-} __attribute__ ((packed));
-
-union ht_param_info{
-        struct {
-                u8 max_rx_ampdu_factor  :2;
-                u8 mpdu_density         :3;
-                u8 reserved             :3;
-        };
-        u8 val;
-} __attribute__ ((packed));
-
-union ht_exra_param_info {
-        struct {
-                u8 ext_chan_offset              :2;
-                u8 tx_chan_width                :1;
-                u8 rifs_mode                    :1;
-                u8 controlled_access_only       :1;
-                u8 service_interval_granularity :3;
-        };
-        u8 val;
-} __attribute__ ((packed));
-
-union ht_operation_mode{
-        struct {
-                u16 op_mode     :2;
-                u16 non_GF      :1;
-                u16 reserved    :13;
-        };
-        u16 val;
-} __attribute__ ((packed));
 
-
-static int sta_ht_info_init(struct ieee80211_ht_capability *ht_cap,
-                            struct ieee80211_ht_additional_info *ht_extra,
-                            struct sta_ht_info *ht_info_ap,
-                            struct sta_ht_info *ht_info)
+static void iwl4965_ht_info_fill(struct ieee80211_conf *conf,
+                                 struct iwl4965_priv *priv)
 {
-        union ht_cap_info cap;
-        union ht_operation_mode op_mode;
-        union ht_param_info param_info;
-        union ht_exra_param_info extra_param_info;
+        struct iwl_ht_info *iwl_conf = &priv->current_ht_config;
+        struct ieee80211_ht_info *ht_conf = &conf->ht_conf;
+        struct ieee80211_ht_bss_info *ht_bss_conf = &conf->ht_bss_conf;
 
         IWL_DEBUG_MAC80211("enter: \n");
 
-        if (!ht_info) {
-                IWL_DEBUG_MAC80211("leave: ht_info is NULL\n");
-                return -1;
+        if (!(conf->flags & IEEE80211_CONF_SUPPORT_HT_MODE)) {
+                iwl_conf->is_ht = 0;
+                return;
         }
 
-        if (ht_cap) {
-                cap.val = (u16) le16_to_cpu(ht_cap->capabilities_info);
-                param_info.val = ht_cap->mac_ht_params_info;
-                ht_info->is_ht = 1;
-                if (cap.short_GI20)
-                        ht_info->sgf |= 0x1;
-                if (cap.short_GI40)
-                        ht_info->sgf |= 0x2;
-                ht_info->is_green_field = cap.green_field;
-                ht_info->max_amsdu_size = cap.maximal_amsdu_size;
-                ht_info->supported_chan_width = cap.supported_chan_width_set;
-                ht_info->tx_mimo_ps_mode = cap.mimo_power_save_mode;
-                memcpy(ht_info->supp_rates, ht_cap->supported_mcs_set, 16);
-
-                ht_info->ampdu_factor = param_info.max_rx_ampdu_factor;
-                ht_info->mpdu_density = param_info.mpdu_density;
-
-                IWL_DEBUG_MAC80211("SISO mask 0x%X MIMO mask 0x%X \n",
-                                    ht_cap->supported_mcs_set[0],
-                                    ht_cap->supported_mcs_set[1]);
-
-                if (ht_info_ap) {
-                        ht_info->control_channel = ht_info_ap->control_channel;
-                        ht_info->extension_chan_offset =
-                                ht_info_ap->extension_chan_offset;
-                        ht_info->tx_chan_width = ht_info_ap->tx_chan_width;
-                        ht_info->operating_mode = ht_info_ap->operating_mode;
-                }
-
-                if (ht_extra) {
-                        extra_param_info.val = ht_extra->ht_param;
-                        ht_info->control_channel = ht_extra->control_chan;
-                        ht_info->extension_chan_offset =
-                            extra_param_info.ext_chan_offset;
-                        ht_info->tx_chan_width = extra_param_info.tx_chan_width;
-                        op_mode.val = (u16)
-                            le16_to_cpu(ht_extra->operation_mode);
-                        ht_info->operating_mode = op_mode.op_mode;
-                        IWL_DEBUG_MAC80211("control channel %d\n",
-                                            ht_extra->control_chan);
-                }
-        } else
-                ht_info->is_ht = 0;
-
+        iwl_conf->is_ht = 1;
+        priv->ps_mode = (u8)((ht_conf->cap & IEEE80211_HT_CAP_MIMO_PS) >> 2);
+
+        if (ht_conf->cap & IEEE80211_HT_CAP_SGI_20)
+                iwl_conf->sgf |= 0x1;
+        if (ht_conf->cap & IEEE80211_HT_CAP_SGI_40)
+                iwl_conf->sgf |= 0x2;
+
+        iwl_conf->is_green_field = !!(ht_conf->cap & IEEE80211_HT_CAP_GRN_FLD);
+        iwl_conf->max_amsdu_size =
+                !!(ht_conf->cap & IEEE80211_HT_CAP_MAX_AMSDU);
+        iwl_conf->supported_chan_width =
+                !!(ht_conf->cap & IEEE80211_HT_CAP_SUP_WIDTH);
+        iwl_conf->tx_mimo_ps_mode =
+                (u8)((ht_conf->cap & IEEE80211_HT_CAP_MIMO_PS) >> 2);
+        memcpy(iwl_conf->supp_mcs_set, ht_conf->supp_mcs_set, 16);
+
+        iwl_conf->control_channel = ht_bss_conf->primary_channel;
+        iwl_conf->extension_chan_offset =
+                ht_bss_conf->bss_cap & IEEE80211_HT_IE_CHA_SEC_OFFSET;
+        iwl_conf->tx_chan_width =
+                !!(ht_bss_conf->bss_cap & IEEE80211_HT_IE_CHA_WIDTH);
+        iwl_conf->ht_protection =
+                ht_bss_conf->bss_op_mode & IEEE80211_HT_IE_HT_PROTECTION;
+        iwl_conf->non_GF_STA_present =
+                !!(ht_bss_conf->bss_op_mode & IEEE80211_HT_IE_NON_GF_STA_PRSNT);
+
+        IWL_DEBUG_MAC80211("control channel %d\n",
+                iwl_conf->control_channel);
         IWL_DEBUG_MAC80211("leave\n");
-        return 0;
 }
 
 static int iwl4965_mac_conf_ht(struct ieee80211_hw *hw,
-                           struct ieee80211_ht_capability *ht_cap,
-                           struct ieee80211_ht_additional_info *ht_extra)
+                               struct ieee80211_conf *conf)
 {
         struct iwl4965_priv *priv = hw->priv;
-        int rs;
 
         IWL_DEBUG_MAC80211("enter: \n");
 
-        rs = sta_ht_info_init(ht_cap, ht_extra, NULL, &priv->current_assoc_ht);
+        iwl4965_ht_info_fill(conf, priv);
         iwl4965_set_rxon_chain(priv);
 
         if (priv && priv->assoc_id &&
@@ -8372,10 +8296,8 @@ static int iwl4965_mac_conf_ht(struct ieee80211_hw *hw,
                 spin_unlock_irqrestore(&priv->lock, flags);
         }
 
-        IWL_DEBUG_MAC80211("leave: control channel %d\n",
-                        ht_extra->control_chan);
-        return rs;
-
+        IWL_DEBUG_MAC80211("leave:\n");
+        return 0;
 }
 
 static void iwl4965_set_ht_capab(struct ieee80211_hw *hw,
@@ -8400,23 +8322,6 @@ static void iwl4965_set_ht_capab(struct ieee80211_hw *hw,
                                         IEEE80211_HT_CAP_AMPDU_DENSITY);
 }
 
-static void iwl4965_mac_get_ht_capab(struct ieee80211_hw *hw,
-                                 struct ieee80211_ht_capability *ht_cap)
-{
-        u8 use_wide_channel = 1;
-        struct iwl4965_priv *priv = hw->priv;
-
-        IWL_DEBUG_MAC80211("enter: \n");
-        if (priv->channel_width != IWL_CHANNEL_WIDTH_40MHZ)
-                use_wide_channel = 0;
-
-        /* no fat tx allowed on 2.4GHZ */
-        if (priv->phymode != MODE_IEEE80211A)
-                use_wide_channel = 0;
-
-        iwl4965_set_ht_capab(hw, ht_cap, use_wide_channel);
-        IWL_DEBUG_MAC80211("leave: \n");
-}
 #endif /*CONFIG_IWL4965_HT*/
 
 /*****************************************************************************
@@ -9134,7 +9039,6 @@ static struct ieee80211_ops iwl4965_hw_ops = {
         .erp_ie_changed = iwl4965_mac_erp_ie_changed,
 #ifdef CONFIG_IWL4965_HT
         .conf_ht = iwl4965_mac_conf_ht,
-        .get_ht_capab = iwl4965_mac_get_ht_capab,
 #ifdef CONFIG_IWL4965_HT_AGG
         .ht_tx_agg_start = iwl4965_mac_ht_tx_agg_start,
         .ht_tx_agg_stop = iwl4965_mac_ht_tx_agg_stop,