Commit | Line | Data |
---|---|---|
c2d1560a JB |
1 | /* |
2 | * Copyright 2002-2005, Instant802 Networks, Inc. | |
3 | * Copyright 2005-2006, Devicescape Software, Inc. | |
4 | * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> | |
5 | * Copyright 2007 Johannes Berg <johannes@sipsolutions.net> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * utilities for mac80211 | |
12 | */ | |
13 | ||
14 | #include <net/mac80211.h> | |
15 | #include <linux/netdevice.h> | |
16 | #include <linux/types.h> | |
17 | #include <linux/slab.h> | |
18 | #include <linux/skbuff.h> | |
19 | #include <linux/etherdevice.h> | |
20 | #include <linux/if_arp.h> | |
21 | #include <linux/wireless.h> | |
22 | #include <linux/bitmap.h> | |
881d966b | 23 | #include <net/net_namespace.h> |
c2d1560a | 24 | #include <net/cfg80211.h> |
dabeb344 | 25 | #include <net/rtnetlink.h> |
c2d1560a JB |
26 | |
27 | #include "ieee80211_i.h" | |
2c8dccc7 | 28 | #include "rate.h" |
ee385855 | 29 | #include "mesh.h" |
c2d1560a JB |
30 | #include "wme.h" |
31 | ||
32 | /* privid for wiphys to determine whether they belong to us or not */ | |
33 | void *mac80211_wiphy_privid = &mac80211_wiphy_privid; | |
34 | ||
35 | /* See IEEE 802.1H for LLC/SNAP encapsulation/decapsulation */ | |
36 | /* Ethernet-II snap header (RFC1042 for most EtherTypes) */ | |
37 | const unsigned char rfc1042_header[] = | |
38 | { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 }; | |
39 | ||
40 | /* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */ | |
41 | const unsigned char bridge_tunnel_header[] = | |
42 | { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 }; | |
43 | ||
c2d1560a | 44 | |
71364716 RR |
45 | u8 *ieee80211_get_bssid(struct ieee80211_hdr *hdr, size_t len, |
46 | enum ieee80211_if_types type) | |
c2d1560a JB |
47 | { |
48 | u16 fc; | |
49 | ||
98f0b0a3 RR |
50 | /* drop ACK/CTS frames and incorrect hdr len (ctrl) */ |
51 | if (len < 16) | |
c2d1560a JB |
52 | return NULL; |
53 | ||
54 | fc = le16_to_cpu(hdr->frame_control); | |
55 | ||
56 | switch (fc & IEEE80211_FCTL_FTYPE) { | |
57 | case IEEE80211_FTYPE_DATA: | |
98f0b0a3 RR |
58 | if (len < 24) /* drop incorrect hdr len (data) */ |
59 | return NULL; | |
c2d1560a JB |
60 | switch (fc & (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS)) { |
61 | case IEEE80211_FCTL_TODS: | |
62 | return hdr->addr1; | |
63 | case (IEEE80211_FCTL_TODS | IEEE80211_FCTL_FROMDS): | |
64 | return NULL; | |
65 | case IEEE80211_FCTL_FROMDS: | |
66 | return hdr->addr2; | |
67 | case 0: | |
68 | return hdr->addr3; | |
69 | } | |
70 | break; | |
71 | case IEEE80211_FTYPE_MGMT: | |
98f0b0a3 RR |
72 | if (len < 24) /* drop incorrect hdr len (mgmt) */ |
73 | return NULL; | |
c2d1560a JB |
74 | return hdr->addr3; |
75 | case IEEE80211_FTYPE_CTL: | |
76 | if ((fc & IEEE80211_FCTL_STYPE) == IEEE80211_STYPE_PSPOLL) | |
77 | return hdr->addr1; | |
71364716 RR |
78 | else if ((fc & IEEE80211_FCTL_STYPE) == |
79 | IEEE80211_STYPE_BACK_REQ) { | |
80 | switch (type) { | |
81 | case IEEE80211_IF_TYPE_STA: | |
82 | return hdr->addr2; | |
83 | case IEEE80211_IF_TYPE_AP: | |
84 | case IEEE80211_IF_TYPE_VLAN: | |
85 | return hdr->addr1; | |
86 | default: | |
87 | return NULL; | |
88 | } | |
89 | } | |
c2d1560a JB |
90 | else |
91 | return NULL; | |
92 | } | |
93 | ||
94 | return NULL; | |
95 | } | |
96 | ||
97 | int ieee80211_get_hdrlen(u16 fc) | |
98 | { | |
99 | int hdrlen = 24; | |
100 | ||
101 | switch (fc & IEEE80211_FCTL_FTYPE) { | |
102 | case IEEE80211_FTYPE_DATA: | |
103 | if ((fc & IEEE80211_FCTL_FROMDS) && (fc & IEEE80211_FCTL_TODS)) | |
104 | hdrlen = 30; /* Addr4 */ | |
105 | /* | |
106 | * The QoS Control field is two bytes and its presence is | |
107 | * indicated by the IEEE80211_STYPE_QOS_DATA bit. Add 2 to | |
108 | * hdrlen if that bit is set. | |
109 | * This works by masking out the bit and shifting it to | |
110 | * bit position 1 so the result has the value 0 or 2. | |
111 | */ | |
112 | hdrlen += (fc & IEEE80211_STYPE_QOS_DATA) | |
113 | >> (ilog2(IEEE80211_STYPE_QOS_DATA)-1); | |
114 | break; | |
115 | case IEEE80211_FTYPE_CTL: | |
116 | /* | |
117 | * ACK and CTS are 10 bytes, all others 16. To see how | |
118 | * to get this condition consider | |
119 | * subtype mask: 0b0000000011110000 (0x00F0) | |
120 | * ACK subtype: 0b0000000011010000 (0x00D0) | |
121 | * CTS subtype: 0b0000000011000000 (0x00C0) | |
122 | * bits that matter: ^^^ (0x00E0) | |
123 | * value of those: 0b0000000011000000 (0x00C0) | |
124 | */ | |
125 | if ((fc & 0xE0) == 0xC0) | |
126 | hdrlen = 10; | |
127 | else | |
128 | hdrlen = 16; | |
129 | break; | |
130 | } | |
131 | ||
132 | return hdrlen; | |
133 | } | |
134 | EXPORT_SYMBOL(ieee80211_get_hdrlen); | |
135 | ||
136 | int ieee80211_get_hdrlen_from_skb(const struct sk_buff *skb) | |
137 | { | |
138 | const struct ieee80211_hdr *hdr = (const struct ieee80211_hdr *) skb->data; | |
139 | int hdrlen; | |
140 | ||
141 | if (unlikely(skb->len < 10)) | |
142 | return 0; | |
143 | hdrlen = ieee80211_get_hdrlen(le16_to_cpu(hdr->frame_control)); | |
144 | if (unlikely(hdrlen > skb->len)) | |
145 | return 0; | |
146 | return hdrlen; | |
147 | } | |
148 | EXPORT_SYMBOL(ieee80211_get_hdrlen_from_skb); | |
149 | ||
ee385855 LCC |
150 | int ieee80211_get_mesh_hdrlen(struct ieee80211s_hdr *meshhdr) |
151 | { | |
152 | int ae = meshhdr->flags & IEEE80211S_FLAGS_AE; | |
153 | /* 7.1.3.5a.2 */ | |
154 | switch (ae) { | |
155 | case 0: | |
ef269254 | 156 | return 6; |
ee385855 | 157 | case 1: |
ef269254 | 158 | return 12; |
ee385855 | 159 | case 2: |
ef269254 | 160 | return 18; |
ee385855 | 161 | case 3: |
ef269254 | 162 | return 24; |
ee385855 | 163 | default: |
ef269254 | 164 | return 6; |
ee385855 LCC |
165 | } |
166 | } | |
ee385855 | 167 | |
5cf121c3 | 168 | void ieee80211_tx_set_protected(struct ieee80211_tx_data *tx) |
c2d1560a JB |
169 | { |
170 | struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) tx->skb->data; | |
171 | ||
172 | hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED); | |
5cf121c3 | 173 | if (tx->extra_frag) { |
c2d1560a JB |
174 | struct ieee80211_hdr *fhdr; |
175 | int i; | |
5cf121c3 | 176 | for (i = 0; i < tx->num_extra_frag; i++) { |
c2d1560a | 177 | fhdr = (struct ieee80211_hdr *) |
5cf121c3 | 178 | tx->extra_frag[i]->data; |
c2d1560a JB |
179 | fhdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED); |
180 | } | |
181 | } | |
182 | } | |
183 | ||
184 | int ieee80211_frame_duration(struct ieee80211_local *local, size_t len, | |
185 | int rate, int erp, int short_preamble) | |
186 | { | |
187 | int dur; | |
188 | ||
189 | /* calculate duration (in microseconds, rounded up to next higher | |
190 | * integer if it includes a fractional microsecond) to send frame of | |
191 | * len bytes (does not include FCS) at the given rate. Duration will | |
192 | * also include SIFS. | |
193 | * | |
194 | * rate is in 100 kbps, so divident is multiplied by 10 in the | |
195 | * DIV_ROUND_UP() operations. | |
196 | */ | |
197 | ||
8318d78a | 198 | if (local->hw.conf.channel->band == IEEE80211_BAND_5GHZ || erp) { |
c2d1560a JB |
199 | /* |
200 | * OFDM: | |
201 | * | |
202 | * N_DBPS = DATARATE x 4 | |
203 | * N_SYM = Ceiling((16+8xLENGTH+6) / N_DBPS) | |
204 | * (16 = SIGNAL time, 6 = tail bits) | |
205 | * TXTIME = T_PREAMBLE + T_SIGNAL + T_SYM x N_SYM + Signal Ext | |
206 | * | |
207 | * T_SYM = 4 usec | |
208 | * 802.11a - 17.5.2: aSIFSTime = 16 usec | |
209 | * 802.11g - 19.8.4: aSIFSTime = 10 usec + | |
210 | * signal ext = 6 usec | |
211 | */ | |
c2d1560a JB |
212 | dur = 16; /* SIFS + signal ext */ |
213 | dur += 16; /* 17.3.2.3: T_PREAMBLE = 16 usec */ | |
214 | dur += 4; /* 17.3.2.3: T_SIGNAL = 4 usec */ | |
215 | dur += 4 * DIV_ROUND_UP((16 + 8 * (len + 4) + 6) * 10, | |
216 | 4 * rate); /* T_SYM x N_SYM */ | |
217 | } else { | |
218 | /* | |
219 | * 802.11b or 802.11g with 802.11b compatibility: | |
220 | * 18.3.4: TXTIME = PreambleLength + PLCPHeaderTime + | |
221 | * Ceiling(((LENGTH+PBCC)x8)/DATARATE). PBCC=0. | |
222 | * | |
223 | * 802.11 (DS): 15.3.3, 802.11b: 18.3.4 | |
224 | * aSIFSTime = 10 usec | |
225 | * aPreambleLength = 144 usec or 72 usec with short preamble | |
226 | * aPLCPHeaderLength = 48 usec or 24 usec with short preamble | |
227 | */ | |
228 | dur = 10; /* aSIFSTime = 10 usec */ | |
229 | dur += short_preamble ? (72 + 24) : (144 + 48); | |
230 | ||
231 | dur += DIV_ROUND_UP(8 * (len + 4) * 10, rate); | |
232 | } | |
233 | ||
234 | return dur; | |
235 | } | |
236 | ||
237 | /* Exported duration function for driver use */ | |
32bfd35d JB |
238 | __le16 ieee80211_generic_frame_duration(struct ieee80211_hw *hw, |
239 | struct ieee80211_vif *vif, | |
8318d78a JB |
240 | size_t frame_len, |
241 | struct ieee80211_rate *rate) | |
c2d1560a JB |
242 | { |
243 | struct ieee80211_local *local = hw_to_local(hw); | |
32bfd35d | 244 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
c2d1560a JB |
245 | u16 dur; |
246 | int erp; | |
247 | ||
8318d78a JB |
248 | erp = 0; |
249 | if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE) | |
250 | erp = rate->flags & IEEE80211_RATE_ERP_G; | |
251 | ||
252 | dur = ieee80211_frame_duration(local, frame_len, rate->bitrate, erp, | |
471b3efd | 253 | sdata->bss_conf.use_short_preamble); |
c2d1560a JB |
254 | |
255 | return cpu_to_le16(dur); | |
256 | } | |
257 | EXPORT_SYMBOL(ieee80211_generic_frame_duration); | |
258 | ||
32bfd35d JB |
259 | __le16 ieee80211_rts_duration(struct ieee80211_hw *hw, |
260 | struct ieee80211_vif *vif, size_t frame_len, | |
e039fa4a | 261 | const struct ieee80211_tx_info *frame_txctl) |
c2d1560a JB |
262 | { |
263 | struct ieee80211_local *local = hw_to_local(hw); | |
264 | struct ieee80211_rate *rate; | |
32bfd35d | 265 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
471b3efd | 266 | bool short_preamble; |
c2d1560a JB |
267 | int erp; |
268 | u16 dur; | |
2e92e6f2 JB |
269 | struct ieee80211_supported_band *sband; |
270 | ||
271 | sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; | |
c2d1560a | 272 | |
471b3efd | 273 | short_preamble = sdata->bss_conf.use_short_preamble; |
7e9ed188 | 274 | |
e039fa4a | 275 | rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx]; |
8318d78a JB |
276 | |
277 | erp = 0; | |
278 | if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE) | |
279 | erp = rate->flags & IEEE80211_RATE_ERP_G; | |
c2d1560a JB |
280 | |
281 | /* CTS duration */ | |
8318d78a | 282 | dur = ieee80211_frame_duration(local, 10, rate->bitrate, |
c2d1560a JB |
283 | erp, short_preamble); |
284 | /* Data frame duration */ | |
8318d78a | 285 | dur += ieee80211_frame_duration(local, frame_len, rate->bitrate, |
c2d1560a JB |
286 | erp, short_preamble); |
287 | /* ACK duration */ | |
8318d78a | 288 | dur += ieee80211_frame_duration(local, 10, rate->bitrate, |
c2d1560a JB |
289 | erp, short_preamble); |
290 | ||
291 | return cpu_to_le16(dur); | |
292 | } | |
293 | EXPORT_SYMBOL(ieee80211_rts_duration); | |
294 | ||
32bfd35d JB |
295 | __le16 ieee80211_ctstoself_duration(struct ieee80211_hw *hw, |
296 | struct ieee80211_vif *vif, | |
c2d1560a | 297 | size_t frame_len, |
e039fa4a | 298 | const struct ieee80211_tx_info *frame_txctl) |
c2d1560a JB |
299 | { |
300 | struct ieee80211_local *local = hw_to_local(hw); | |
301 | struct ieee80211_rate *rate; | |
32bfd35d | 302 | struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif); |
471b3efd | 303 | bool short_preamble; |
c2d1560a JB |
304 | int erp; |
305 | u16 dur; | |
2e92e6f2 JB |
306 | struct ieee80211_supported_band *sband; |
307 | ||
308 | sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; | |
c2d1560a | 309 | |
471b3efd | 310 | short_preamble = sdata->bss_conf.use_short_preamble; |
7e9ed188 | 311 | |
e039fa4a | 312 | rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx]; |
8318d78a JB |
313 | erp = 0; |
314 | if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE) | |
315 | erp = rate->flags & IEEE80211_RATE_ERP_G; | |
c2d1560a JB |
316 | |
317 | /* Data frame duration */ | |
8318d78a | 318 | dur = ieee80211_frame_duration(local, frame_len, rate->bitrate, |
c2d1560a | 319 | erp, short_preamble); |
e039fa4a | 320 | if (!(frame_txctl->flags & IEEE80211_TX_CTL_NO_ACK)) { |
c2d1560a | 321 | /* ACK duration */ |
8318d78a | 322 | dur += ieee80211_frame_duration(local, 10, rate->bitrate, |
c2d1560a JB |
323 | erp, short_preamble); |
324 | } | |
325 | ||
326 | return cpu_to_le16(dur); | |
327 | } | |
328 | EXPORT_SYMBOL(ieee80211_ctstoself_duration); | |
329 | ||
c2d1560a JB |
330 | void ieee80211_wake_queue(struct ieee80211_hw *hw, int queue) |
331 | { | |
332 | struct ieee80211_local *local = hw_to_local(hw); | |
333 | ||
334 | if (test_and_clear_bit(IEEE80211_LINK_STATE_XOFF, | |
335 | &local->state[queue])) { | |
336 | if (test_bit(IEEE80211_LINK_STATE_PENDING, | |
337 | &local->state[queue])) | |
338 | tasklet_schedule(&local->tx_pending_tasklet); | |
339 | else | |
340 | if (!ieee80211_qdisc_installed(local->mdev)) { | |
341 | if (queue == 0) | |
342 | netif_wake_queue(local->mdev); | |
343 | } else | |
344 | __netif_schedule(local->mdev); | |
345 | } | |
346 | } | |
347 | EXPORT_SYMBOL(ieee80211_wake_queue); | |
348 | ||
349 | void ieee80211_stop_queue(struct ieee80211_hw *hw, int queue) | |
350 | { | |
351 | struct ieee80211_local *local = hw_to_local(hw); | |
352 | ||
353 | if (!ieee80211_qdisc_installed(local->mdev) && queue == 0) | |
354 | netif_stop_queue(local->mdev); | |
355 | set_bit(IEEE80211_LINK_STATE_XOFF, &local->state[queue]); | |
356 | } | |
357 | EXPORT_SYMBOL(ieee80211_stop_queue); | |
358 | ||
c2d1560a JB |
359 | void ieee80211_stop_queues(struct ieee80211_hw *hw) |
360 | { | |
361 | int i; | |
362 | ||
c4680470 | 363 | for (i = 0; i < hw->queues + hw->ampdu_queues; i++) |
c2d1560a JB |
364 | ieee80211_stop_queue(hw, i); |
365 | } | |
366 | EXPORT_SYMBOL(ieee80211_stop_queues); | |
367 | ||
368 | void ieee80211_wake_queues(struct ieee80211_hw *hw) | |
369 | { | |
370 | int i; | |
371 | ||
c4680470 | 372 | for (i = 0; i < hw->queues + hw->ampdu_queues; i++) |
c2d1560a JB |
373 | ieee80211_wake_queue(hw, i); |
374 | } | |
375 | EXPORT_SYMBOL(ieee80211_wake_queues); | |
dabeb344 | 376 | |
32bfd35d JB |
377 | void ieee80211_iterate_active_interfaces( |
378 | struct ieee80211_hw *hw, | |
379 | void (*iterator)(void *data, u8 *mac, | |
380 | struct ieee80211_vif *vif), | |
381 | void *data) | |
dabeb344 JB |
382 | { |
383 | struct ieee80211_local *local = hw_to_local(hw); | |
384 | struct ieee80211_sub_if_data *sdata; | |
385 | ||
e38bad47 | 386 | rcu_read_lock(); |
dabeb344 | 387 | |
e38bad47 | 388 | list_for_each_entry_rcu(sdata, &local->interfaces, list) { |
51fb61e7 | 389 | switch (sdata->vif.type) { |
dabeb344 JB |
390 | case IEEE80211_IF_TYPE_INVALID: |
391 | case IEEE80211_IF_TYPE_MNTR: | |
392 | case IEEE80211_IF_TYPE_VLAN: | |
393 | continue; | |
394 | case IEEE80211_IF_TYPE_AP: | |
395 | case IEEE80211_IF_TYPE_STA: | |
396 | case IEEE80211_IF_TYPE_IBSS: | |
397 | case IEEE80211_IF_TYPE_WDS: | |
6032f934 | 398 | case IEEE80211_IF_TYPE_MESH_POINT: |
dabeb344 JB |
399 | break; |
400 | } | |
401 | if (sdata->dev == local->mdev) | |
402 | continue; | |
403 | if (netif_running(sdata->dev)) | |
404 | iterator(data, sdata->dev->dev_addr, | |
32bfd35d | 405 | &sdata->vif); |
dabeb344 | 406 | } |
e38bad47 JB |
407 | |
408 | rcu_read_unlock(); | |
dabeb344 JB |
409 | } |
410 | EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces); |