rt2x00: Fix SM PS check
[linux-2.6/btrfs-unstable.git] / drivers / net / wireless / rt2x00 / rt2x00ht.c
blob48b6ed426da5fc0cff19147c51d584a22691005d
1 /*
2 Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com>
3 <http://rt2x00.serialmonkey.com>
5 This program is free software; you can redistribute it and/or modify
6 it under the terms of the GNU General Public License as published by
7 the Free Software Foundation; either version 2 of the License, or
8 (at your option) any later version.
10 This program is distributed in the hope that it will be useful,
11 but WITHOUT ANY WARRANTY; without even the implied warranty of
12 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 GNU General Public License for more details.
15 You should have received a copy of the GNU General Public License
16 along with this program; if not, write to the
17 Free Software Foundation, Inc.,
18 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
22 Module: rt2x00lib
23 Abstract: rt2x00 HT specific routines.
26 #include <linux/kernel.h>
27 #include <linux/module.h>
29 #include "rt2x00.h"
30 #include "rt2x00lib.h"
32 void rt2x00ht_create_tx_descriptor(struct queue_entry *entry,
33 struct txentry_desc *txdesc,
34 const struct rt2x00_rate *hwrate)
36 struct ieee80211_tx_info *tx_info = IEEE80211_SKB_CB(entry->skb);
37 struct ieee80211_tx_rate *txrate = &tx_info->control.rates[0];
38 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)entry->skb->data;
40 if (tx_info->control.sta)
41 txdesc->mpdu_density =
42 tx_info->control.sta->ht_cap.ampdu_density;
43 else
44 txdesc->mpdu_density = 0;
46 txdesc->ba_size = 7; /* FIXME: What value is needed? */
48 txdesc->stbc =
49 (tx_info->flags & IEEE80211_TX_CTL_STBC) >> IEEE80211_TX_CTL_STBC_SHIFT;
52 * If IEEE80211_TX_RC_MCS is set txrate->idx just contains the
53 * mcs rate to be used
55 if (txrate->flags & IEEE80211_TX_RC_MCS) {
56 txdesc->mcs = txrate->idx;
59 * MIMO PS should be set to 1 for STA's using dynamic SM PS
60 * when using more then one tx stream (>MCS7).
62 if (tx_info->control.sta && txdesc->mcs > 7 &&
63 ((tx_info->control.sta->ht_cap.cap &
64 IEEE80211_HT_CAP_SM_PS) >>
65 IEEE80211_HT_CAP_SM_PS_SHIFT) ==
66 WLAN_HT_CAP_SM_PS_DYNAMIC)
67 __set_bit(ENTRY_TXD_HT_MIMO_PS, &txdesc->flags);
68 } else {
69 txdesc->mcs = rt2x00_get_rate_mcs(hwrate->mcs);
70 if (txrate->flags & IEEE80211_TX_RC_USE_SHORT_PREAMBLE)
71 txdesc->mcs |= 0x08;
76 * Convert flags
78 if (tx_info->flags & IEEE80211_TX_CTL_AMPDU)
79 __set_bit(ENTRY_TXD_HT_AMPDU, &txdesc->flags);
82 * Determine HT Mix/Greenfield rate mode
84 if (txrate->flags & IEEE80211_TX_RC_MCS)
85 txdesc->rate_mode = RATE_MODE_HT_MIX;
86 if (txrate->flags & IEEE80211_TX_RC_GREEN_FIELD)
87 txdesc->rate_mode = RATE_MODE_HT_GREENFIELD;
88 if (txrate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
89 __set_bit(ENTRY_TXD_HT_BW_40, &txdesc->flags);
90 if (txrate->flags & IEEE80211_TX_RC_SHORT_GI)
91 __set_bit(ENTRY_TXD_HT_SHORT_GI, &txdesc->flags);
94 * Determine IFS values
95 * - Use TXOP_BACKOFF for management frames
96 * - Use TXOP_SIFS for fragment bursts
97 * - Use TXOP_HTTXOP for everything else
99 * Note: rt2800 devices won't use CTS protection (if used)
100 * for frames not transmitted with TXOP_HTTXOP
102 if (ieee80211_is_mgmt(hdr->frame_control))
103 txdesc->txop = TXOP_BACKOFF;
104 else if (!(tx_info->flags & IEEE80211_TX_CTL_FIRST_FRAGMENT))
105 txdesc->txop = TXOP_SIFS;
106 else
107 txdesc->txop = TXOP_HTTXOP;
110 u16 rt2x00ht_center_channel(struct rt2x00_dev *rt2x00dev,
111 struct ieee80211_conf *conf)
113 struct hw_mode_spec *spec = &rt2x00dev->spec;
114 int center_channel;
115 u16 i;
118 * Initialize center channel to current channel.
120 center_channel = spec->channels[conf->channel->hw_value].channel;
123 * Adjust center channel to HT40+ and HT40- operation.
125 if (conf_is_ht40_plus(conf))
126 center_channel += 2;
127 else if (conf_is_ht40_minus(conf))
128 center_channel -= (center_channel == 14) ? 1 : 2;
130 for (i = 0; i < spec->num_channels; i++)
131 if (spec->channels[i].channel == center_channel)
132 return i;
134 WARN_ON(1);
135 return conf->channel->hw_value;