1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16#include <linux/ieee80211.h>
17#include <net/wireless.h>
18#include <net/mac80211.h>
19#include "ieee80211_i.h"
20#include "rate.h"
21
22void ieee80211_ht_cap_ie_to_sta_ht_cap(struct ieee80211_supported_band *sband,
23 struct ieee80211_ht_cap *ht_cap_ie,
24 struct ieee80211_sta_ht_cap *ht_cap)
25{
26 u8 ampdu_info, tx_mcs_set_cap;
27 int i, max_tx_streams;
28
29 BUG_ON(!ht_cap);
30
31 memset(ht_cap, 0, sizeof(*ht_cap));
32
33 if (!ht_cap_ie)
34 return;
35
36 ht_cap->ht_supported = true;
37
38 ht_cap->cap = le16_to_cpu(ht_cap_ie->cap_info) & sband->ht_cap.cap;
39 ht_cap->cap &= ~IEEE80211_HT_CAP_SM_PS;
40 ht_cap->cap |= sband->ht_cap.cap & IEEE80211_HT_CAP_SM_PS;
41
42 ampdu_info = ht_cap_ie->ampdu_params_info;
43 ht_cap->ampdu_factor =
44 ampdu_info & IEEE80211_HT_AMPDU_PARM_FACTOR;
45 ht_cap->ampdu_density =
46 (ampdu_info & IEEE80211_HT_AMPDU_PARM_DENSITY) >> 2;
47
48
49 tx_mcs_set_cap = sband->ht_cap.mcs.tx_params;
50
51
52 if (!(tx_mcs_set_cap & IEEE80211_HT_MCS_TX_DEFINED))
53 return;
54
55
56 if (tx_mcs_set_cap & IEEE80211_HT_MCS_TX_RX_DIFF)
57 max_tx_streams =
58 ((tx_mcs_set_cap & IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK)
59 >> IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT) + 1;
60 else
61 max_tx_streams = IEEE80211_HT_MCS_TX_MAX_STREAMS;
62
63
64
65
66
67
68
69
70 for (i = 0; i < max_tx_streams; i++)
71 ht_cap->mcs.rx_mask[i] =
72 sband->ht_cap.mcs.rx_mask[i] & ht_cap_ie->mcs.rx_mask[i];
73
74 if (tx_mcs_set_cap & IEEE80211_HT_MCS_TX_UNEQUAL_MODULATION)
75 for (i = IEEE80211_HT_MCS_UNEQUAL_MODULATION_START_BYTE;
76 i < IEEE80211_HT_MCS_MASK_LEN; i++)
77 ht_cap->mcs.rx_mask[i] =
78 sband->ht_cap.mcs.rx_mask[i] &
79 ht_cap_ie->mcs.rx_mask[i];
80
81
82 if (sband->ht_cap.mcs.rx_mask[32/8] & ht_cap_ie->mcs.rx_mask[32/8] & 1)
83 ht_cap->mcs.rx_mask[32/8] |= 1;
84}
85
86
87
88
89
90
91u32 ieee80211_enable_ht(struct ieee80211_sub_if_data *sdata,
92 struct ieee80211_ht_info *hti,
93 u16 ap_ht_cap_flags)
94{
95 struct ieee80211_local *local = sdata->local;
96 struct ieee80211_supported_band *sband;
97 struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
98 struct ieee80211_bss_ht_conf ht;
99 struct sta_info *sta;
100 u32 changed = 0;
101 bool enable_ht = true, ht_changed;
102 enum nl80211_channel_type channel_type = NL80211_CHAN_NO_HT;
103
104 sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
105
106 memset(&ht, 0, sizeof(ht));
107
108
109 if (!sband->ht_cap.ht_supported)
110 enable_ht = false;
111
112
113 if (local->hw.conf.channel->center_freq !=
114 ieee80211_channel_to_frequency(hti->control_chan))
115 enable_ht = false;
116
117 if (enable_ht) {
118 channel_type = NL80211_CHAN_HT20;
119
120 if (!(ap_ht_cap_flags & IEEE80211_HT_CAP_40MHZ_INTOLERANT) &&
121 (sband->ht_cap.cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40) &&
122 (hti->ht_param & IEEE80211_HT_PARAM_CHAN_WIDTH_ANY)) {
123 switch(hti->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
124 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
125 channel_type = NL80211_CHAN_HT40PLUS;
126 break;
127 case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
128 channel_type = NL80211_CHAN_HT40MINUS;
129 break;
130 }
131 }
132 }
133
134 ht_changed = conf_is_ht(&local->hw.conf) != enable_ht ||
135 channel_type != local->hw.conf.channel_type;
136
137 local->oper_channel_type = channel_type;
138
139 if (ht_changed) {
140
141 ieee80211_hw_config(local, 0);
142
143 rcu_read_lock();
144
145 sta = sta_info_get(local, ifmgd->bssid);
146 if (sta)
147 rate_control_rate_update(local, sband, sta,
148 IEEE80211_RC_HT_CHANGED);
149
150 rcu_read_unlock();
151
152 }
153
154
155 if (!enable_ht)
156 return 0;
157
158 ht.operation_mode = le16_to_cpu(hti->operation_mode);
159
160
161 if (memcmp(&sdata->vif.bss_conf.ht, &ht, sizeof(ht))) {
162 changed |= BSS_CHANGED_HT;
163 sdata->vif.bss_conf.ht = ht;
164 }
165
166 return changed;
167}
168
169void ieee80211_sta_tear_down_BA_sessions(struct sta_info *sta)
170{
171 int i;
172
173 for (i = 0; i < STA_TID_NUM; i++) {
174 __ieee80211_stop_tx_ba_session(sta, i, WLAN_BACK_INITIATOR);
175 __ieee80211_stop_rx_ba_session(sta, i, WLAN_BACK_RECIPIENT,
176 WLAN_REASON_QSTA_LEAVE_QBSS);
177 }
178}
179
180void ieee80211_send_delba(struct ieee80211_sub_if_data *sdata,
181 const u8 *da, u16 tid,
182 u16 initiator, u16 reason_code)
183{
184 struct ieee80211_local *local = sdata->local;
185 struct sk_buff *skb;
186 struct ieee80211_mgmt *mgmt;
187 u16 params;
188
189 skb = dev_alloc_skb(sizeof(*mgmt) + local->hw.extra_tx_headroom);
190
191 if (!skb) {
192 printk(KERN_ERR "%s: failed to allocate buffer "
193 "for delba frame\n", sdata->dev->name);
194 return;
195 }
196
197 skb_reserve(skb, local->hw.extra_tx_headroom);
198 mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24);
199 memset(mgmt, 0, 24);
200 memcpy(mgmt->da, da, ETH_ALEN);
201 memcpy(mgmt->sa, sdata->dev->dev_addr, ETH_ALEN);
202 if (sdata->vif.type == NL80211_IFTYPE_AP ||
203 sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
204 memcpy(mgmt->bssid, sdata->dev->dev_addr, ETH_ALEN);
205 else if (sdata->vif.type == NL80211_IFTYPE_STATION)
206 memcpy(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN);
207
208 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
209 IEEE80211_STYPE_ACTION);
210
211 skb_put(skb, 1 + sizeof(mgmt->u.action.u.delba));
212
213 mgmt->u.action.category = WLAN_CATEGORY_BACK;
214 mgmt->u.action.u.delba.action_code = WLAN_ACTION_DELBA;
215 params = (u16)(initiator << 11);
216 params |= (u16)(tid << 12);
217
218 mgmt->u.action.u.delba.params = cpu_to_le16(params);
219 mgmt->u.action.u.delba.reason_code = cpu_to_le16(reason_code);
220
221 ieee80211_tx_skb(sdata, skb, 1);
222}
223
224void ieee80211_process_delba(struct ieee80211_sub_if_data *sdata,
225 struct sta_info *sta,
226 struct ieee80211_mgmt *mgmt, size_t len)
227{
228 struct ieee80211_local *local = sdata->local;
229 u16 tid, params;
230 u16 initiator;
231
232 params = le16_to_cpu(mgmt->u.action.u.delba.params);
233 tid = (params & IEEE80211_DELBA_PARAM_TID_MASK) >> 12;
234 initiator = (params & IEEE80211_DELBA_PARAM_INITIATOR_MASK) >> 11;
235
236#ifdef CONFIG_MAC80211_HT_DEBUG
237 if (net_ratelimit())
238 printk(KERN_DEBUG "delba from %pM (%s) tid %d reason code %d\n",
239 mgmt->sa, initiator ? "initiator" : "recipient", tid,
240 mgmt->u.action.u.delba.reason_code);
241#endif
242
243 if (initiator == WLAN_BACK_INITIATOR)
244 ieee80211_sta_stop_rx_ba_session(sdata, sta->sta.addr, tid,
245 WLAN_BACK_INITIATOR, 0);
246 else {
247 spin_lock_bh(&sta->lock);
248 sta->ampdu_mlme.tid_state_tx[tid] =
249 HT_AGG_STATE_OPERATIONAL;
250 spin_unlock_bh(&sta->lock);
251 ieee80211_stop_tx_ba_session(&local->hw, sta->sta.addr, tid,
252 WLAN_BACK_RECIPIENT);
253 }
254}
255
