4 * Copyright 2003, Jouni Malinen <jkmaline@cc.hut.fi>
5 * Copyright 2002-2005, Instant802 Networks, Inc.
6 * Copyright 2005-2006, Devicescape Software, Inc.
7 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
8 * Copyright 2007, Michael Wu <flamingice@sourmilk.net>
9 * Copyright 2007-2008, Intel Corporation
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of the GNU General Public License version 2 as
13 * published by the Free Software Foundation.
16 #include <linux/ieee80211.h>
17 #include <net/wireless.h>
18 #include <net/mac80211.h>
19 #include "ieee80211_i.h"
21 void ieee80211_ht_cap_ie_to_sta_ht_cap(struct ieee80211_supported_band
*sband
,
22 struct ieee80211_ht_cap
*ht_cap_ie
,
23 struct ieee80211_sta_ht_cap
*ht_cap
)
25 u8 ampdu_info
, tx_mcs_set_cap
;
26 int i
, max_tx_streams
;
30 memset(ht_cap
, 0, sizeof(*ht_cap
));
35 ht_cap
->ht_supported
= true;
37 ht_cap
->cap
= le16_to_cpu(ht_cap_ie
->cap_info
) & sband
->ht_cap
.cap
;
38 ht_cap
->cap
&= ~IEEE80211_HT_CAP_SM_PS
;
39 ht_cap
->cap
|= sband
->ht_cap
.cap
& IEEE80211_HT_CAP_SM_PS
;
41 ampdu_info
= ht_cap_ie
->ampdu_params_info
;
42 ht_cap
->ampdu_factor
=
43 ampdu_info
& IEEE80211_HT_AMPDU_PARM_FACTOR
;
44 ht_cap
->ampdu_density
=
45 (ampdu_info
& IEEE80211_HT_AMPDU_PARM_DENSITY
) >> 2;
47 /* own MCS TX capabilities */
48 tx_mcs_set_cap
= sband
->ht_cap
.mcs
.tx_params
;
50 /* can we TX with MCS rates? */
51 if (!(tx_mcs_set_cap
& IEEE80211_HT_MCS_TX_DEFINED
))
54 /* Counting from 0, therefore +1 */
55 if (tx_mcs_set_cap
& IEEE80211_HT_MCS_TX_RX_DIFF
)
57 ((tx_mcs_set_cap
& IEEE80211_HT_MCS_TX_MAX_STREAMS_MASK
)
58 >> IEEE80211_HT_MCS_TX_MAX_STREAMS_SHIFT
) + 1;
60 max_tx_streams
= IEEE80211_HT_MCS_TX_MAX_STREAMS
;
63 * 802.11n D5.0 20.3.5 / 20.6 says:
64 * - indices 0 to 7 and 32 are single spatial stream
65 * - 8 to 31 are multiple spatial streams using equal modulation
66 * [8..15 for two streams, 16..23 for three and 24..31 for four]
67 * - remainder are multiple spatial streams using unequal modulation
69 for (i
= 0; i
< max_tx_streams
; i
++)
70 ht_cap
->mcs
.rx_mask
[i
] =
71 sband
->ht_cap
.mcs
.rx_mask
[i
] & ht_cap_ie
->mcs
.rx_mask
[i
];
73 if (tx_mcs_set_cap
& IEEE80211_HT_MCS_TX_UNEQUAL_MODULATION
)
74 for (i
= IEEE80211_HT_MCS_UNEQUAL_MODULATION_START_BYTE
;
75 i
< IEEE80211_HT_MCS_MASK_LEN
; i
++)
76 ht_cap
->mcs
.rx_mask
[i
] =
77 sband
->ht_cap
.mcs
.rx_mask
[i
] &
78 ht_cap_ie
->mcs
.rx_mask
[i
];
80 /* handle MCS rate 32 too */
81 if (sband
->ht_cap
.mcs
.rx_mask
[32/8] & ht_cap_ie
->mcs
.rx_mask
[32/8] & 1)
82 ht_cap
->mcs
.rx_mask
[32/8] |= 1;
86 * ieee80211_enable_ht should be called only after the operating band
87 * has been determined as ht configuration depends on the hw's
88 * HT abilities for a specific band.
90 u32
ieee80211_enable_ht(struct ieee80211_sub_if_data
*sdata
,
91 struct ieee80211_ht_info
*hti
,
94 struct ieee80211_local
*local
= sdata
->local
;
95 struct ieee80211_supported_band
*sband
;
96 struct ieee80211_bss_ht_conf ht
;
98 bool enable_ht
= true, ht_changed
;
99 enum nl80211_channel_type channel_type
= NL80211_CHAN_NO_HT
;
101 sband
= local
->hw
.wiphy
->bands
[local
->hw
.conf
.channel
->band
];
103 memset(&ht
, 0, sizeof(ht
));
105 /* HT is not supported */
106 if (!sband
->ht_cap
.ht_supported
)
109 /* check that channel matches the right operating channel */
110 if (local
->hw
.conf
.channel
->center_freq
!=
111 ieee80211_channel_to_frequency(hti
->control_chan
))
115 channel_type
= NL80211_CHAN_HT20
;
117 if (!(ap_ht_cap_flags
& IEEE80211_HT_CAP_40MHZ_INTOLERANT
) &&
118 (sband
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
) &&
119 (hti
->ht_param
& IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
)) {
120 switch(hti
->ht_param
& IEEE80211_HT_PARAM_CHA_SEC_OFFSET
) {
121 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE
:
122 channel_type
= NL80211_CHAN_HT40PLUS
;
124 case IEEE80211_HT_PARAM_CHA_SEC_BELOW
:
125 channel_type
= NL80211_CHAN_HT40MINUS
;
131 ht_changed
= conf_is_ht(&local
->hw
.conf
) != enable_ht
||
132 channel_type
!= local
->hw
.conf
.channel_type
;
134 local
->oper_channel_type
= channel_type
;
137 /* channel_type change automatically detected */
138 ieee80211_hw_config(local
, 0);
145 ht
.operation_mode
= le16_to_cpu(hti
->operation_mode
);
147 /* if bss configuration changed store the new one */
148 if (memcmp(&sdata
->vif
.bss_conf
.ht
, &ht
, sizeof(ht
))) {
149 changed
|= BSS_CHANGED_HT
;
150 sdata
->vif
.bss_conf
.ht
= ht
;
156 void ieee80211_sta_tear_down_BA_sessions(struct ieee80211_sub_if_data
*sdata
, u8
*addr
)
158 struct ieee80211_local
*local
= sdata
->local
;
161 for (i
= 0; i
< STA_TID_NUM
; i
++) {
162 ieee80211_stop_tx_ba_session(&local
->hw
, addr
, i
,
163 WLAN_BACK_INITIATOR
);
164 ieee80211_sta_stop_rx_ba_session(sdata
, addr
, i
,
166 WLAN_REASON_QSTA_LEAVE_QBSS
);
170 void ieee80211_send_delba(struct ieee80211_sub_if_data
*sdata
,
171 const u8
*da
, u16 tid
,
172 u16 initiator
, u16 reason_code
)
174 struct ieee80211_local
*local
= sdata
->local
;
175 struct ieee80211_if_sta
*ifsta
= &sdata
->u
.sta
;
177 struct ieee80211_mgmt
*mgmt
;
180 skb
= dev_alloc_skb(sizeof(*mgmt
) + local
->hw
.extra_tx_headroom
);
183 printk(KERN_ERR
"%s: failed to allocate buffer "
184 "for delba frame\n", sdata
->dev
->name
);
188 skb_reserve(skb
, local
->hw
.extra_tx_headroom
);
189 mgmt
= (struct ieee80211_mgmt
*) skb_put(skb
, 24);
191 memcpy(mgmt
->da
, da
, ETH_ALEN
);
192 memcpy(mgmt
->sa
, sdata
->dev
->dev_addr
, ETH_ALEN
);
193 if (sdata
->vif
.type
== NL80211_IFTYPE_AP
)
194 memcpy(mgmt
->bssid
, sdata
->dev
->dev_addr
, ETH_ALEN
);
196 memcpy(mgmt
->bssid
, ifsta
->bssid
, ETH_ALEN
);
197 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
|
198 IEEE80211_STYPE_ACTION
);
200 skb_put(skb
, 1 + sizeof(mgmt
->u
.action
.u
.delba
));
202 mgmt
->u
.action
.category
= WLAN_CATEGORY_BACK
;
203 mgmt
->u
.action
.u
.delba
.action_code
= WLAN_ACTION_DELBA
;
204 params
= (u16
)(initiator
<< 11); /* bit 11 initiator */
205 params
|= (u16
)(tid
<< 12); /* bit 15:12 TID number */
207 mgmt
->u
.action
.u
.delba
.params
= cpu_to_le16(params
);
208 mgmt
->u
.action
.u
.delba
.reason_code
= cpu_to_le16(reason_code
);
210 ieee80211_tx_skb(sdata
, skb
, 1);
213 void ieee80211_process_delba(struct ieee80211_sub_if_data
*sdata
,
214 struct sta_info
*sta
,
215 struct ieee80211_mgmt
*mgmt
, size_t len
)
217 struct ieee80211_local
*local
= sdata
->local
;
221 params
= le16_to_cpu(mgmt
->u
.action
.u
.delba
.params
);
222 tid
= (params
& IEEE80211_DELBA_PARAM_TID_MASK
) >> 12;
223 initiator
= (params
& IEEE80211_DELBA_PARAM_INITIATOR_MASK
) >> 11;
225 #ifdef CONFIG_MAC80211_HT_DEBUG
227 printk(KERN_DEBUG
"delba from %pM (%s) tid %d reason code %d\n",
228 mgmt
->sa
, initiator
? "initiator" : "recipient", tid
,
229 mgmt
->u
.action
.u
.delba
.reason_code
);
230 #endif /* CONFIG_MAC80211_HT_DEBUG */
232 if (initiator
== WLAN_BACK_INITIATOR
)
233 ieee80211_sta_stop_rx_ba_session(sdata
, sta
->sta
.addr
, tid
,
234 WLAN_BACK_INITIATOR
, 0);
235 else { /* WLAN_BACK_RECIPIENT */
236 spin_lock_bh(&sta
->lock
);
237 sta
->ampdu_mlme
.tid_state_tx
[tid
] =
238 HT_AGG_STATE_OPERATIONAL
;
239 spin_unlock_bh(&sta
->lock
);
240 ieee80211_stop_tx_ba_session(&local
->hw
, sta
->sta
.addr
, tid
,
241 WLAN_BACK_RECIPIENT
);