2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
11 #include <net/mac80211.h>
12 #include <net/ieee80211_radiotap.h>
13 #include <linux/module.h>
14 #include <linux/init.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/rtnetlink.h>
23 #include <linux/bitmap.h>
24 #include <net/cfg80211.h>
26 #include "ieee80211_common.h"
27 #include "ieee80211_i.h"
28 #include "ieee80211_rate.h"
32 #include "ieee80211_led.h"
33 #include "ieee80211_cfg.h"
35 #include "debugfs_netdev.h"
37 /* privid for wiphys to determine whether they belong to us or not */
38 void *mac80211_wiphy_privid
= &mac80211_wiphy_privid
;
40 /* See IEEE 802.1H for LLC/SNAP encapsulation/decapsulation */
41 /* Ethernet-II snap header (RFC1042 for most EtherTypes) */
42 const unsigned char rfc1042_header
[] =
43 { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 };
45 /* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */
46 const unsigned char bridge_tunnel_header
[] =
47 { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 };
49 /* No encapsulation header if EtherType < 0x600 (=length) */
50 static const unsigned char eapol_header
[] =
51 { 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00, 0x88, 0x8e };
55 * For seeing transmitted packets on monitor interfaces
56 * we have a radiotap header too.
58 struct ieee80211_tx_status_rtap_hdr
{
59 struct ieee80211_radiotap_header hdr
;
62 } __attribute__ ((packed
));
65 static int rate_list_match(const int *rate_list
, int rate
)
72 for (i
= 0; rate_list
[i
] >= 0; i
++)
73 if (rate_list
[i
] == rate
)
80 void ieee80211_prepare_rates(struct ieee80211_local
*local
,
81 struct ieee80211_hw_mode
*mode
)
85 for (i
= 0; i
< mode
->num_rates
; i
++) {
86 struct ieee80211_rate
*rate
= &mode
->rates
[i
];
88 rate
->flags
&= ~(IEEE80211_RATE_SUPPORTED
|
89 IEEE80211_RATE_BASIC
);
91 if (local
->supp_rates
[mode
->mode
]) {
92 if (!rate_list_match(local
->supp_rates
[mode
->mode
],
97 rate
->flags
|= IEEE80211_RATE_SUPPORTED
;
99 /* Use configured basic rate set if it is available. If not,
100 * use defaults that are sane for most cases. */
101 if (local
->basic_rates
[mode
->mode
]) {
102 if (rate_list_match(local
->basic_rates
[mode
->mode
],
104 rate
->flags
|= IEEE80211_RATE_BASIC
;
105 } else switch (mode
->mode
) {
106 case MODE_IEEE80211A
:
107 if (rate
->rate
== 60 || rate
->rate
== 120 ||
109 rate
->flags
|= IEEE80211_RATE_BASIC
;
111 case MODE_IEEE80211B
:
112 if (rate
->rate
== 10 || rate
->rate
== 20)
113 rate
->flags
|= IEEE80211_RATE_BASIC
;
115 case MODE_ATHEROS_TURBO
:
116 if (rate
->rate
== 120 || rate
->rate
== 240 ||
118 rate
->flags
|= IEEE80211_RATE_BASIC
;
120 case MODE_IEEE80211G
:
121 if (rate
->rate
== 10 || rate
->rate
== 20 ||
122 rate
->rate
== 55 || rate
->rate
== 110)
123 rate
->flags
|= IEEE80211_RATE_BASIC
;
127 /* Set ERP and MANDATORY flags based on phymode */
128 switch (mode
->mode
) {
129 case MODE_IEEE80211A
:
130 if (rate
->rate
== 60 || rate
->rate
== 120 ||
132 rate
->flags
|= IEEE80211_RATE_MANDATORY
;
134 case MODE_IEEE80211B
:
135 if (rate
->rate
== 10)
136 rate
->flags
|= IEEE80211_RATE_MANDATORY
;
138 case MODE_ATHEROS_TURBO
:
140 case MODE_IEEE80211G
:
141 if (rate
->rate
== 10 || rate
->rate
== 20 ||
142 rate
->rate
== 55 || rate
->rate
== 110 ||
143 rate
->rate
== 60 || rate
->rate
== 120 ||
145 rate
->flags
|= IEEE80211_RATE_MANDATORY
;
148 if (ieee80211_is_erp_rate(mode
->mode
, rate
->rate
))
149 rate
->flags
|= IEEE80211_RATE_ERP
;
154 void ieee80211_key_threshold_notify(struct net_device
*dev
,
155 struct ieee80211_key
*key
,
156 struct sta_info
*sta
)
158 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
160 struct ieee80211_msg_key_notification
*msg
;
162 /* if no one will get it anyway, don't even allocate it.
163 * unlikely because this is only relevant for APs
164 * where the device must be open... */
165 if (unlikely(!local
->apdev
))
168 skb
= dev_alloc_skb(sizeof(struct ieee80211_frame_info
) +
169 sizeof(struct ieee80211_msg_key_notification
));
173 skb_reserve(skb
, sizeof(struct ieee80211_frame_info
));
174 msg
= (struct ieee80211_msg_key_notification
*)
175 skb_put(skb
, sizeof(struct ieee80211_msg_key_notification
));
176 msg
->tx_rx_count
= key
->tx_rx_count
;
177 memcpy(msg
->ifname
, dev
->name
, IFNAMSIZ
);
179 memcpy(msg
->addr
, sta
->addr
, ETH_ALEN
);
181 memset(msg
->addr
, 0xff, ETH_ALEN
);
183 key
->tx_rx_count
= 0;
185 ieee80211_rx_mgmt(local
, skb
, NULL
,
186 ieee80211_msg_key_threshold_notification
);
190 u8
*ieee80211_get_bssid(struct ieee80211_hdr
*hdr
, size_t len
)
197 fc
= le16_to_cpu(hdr
->frame_control
);
199 switch (fc
& IEEE80211_FCTL_FTYPE
) {
200 case IEEE80211_FTYPE_DATA
:
201 switch (fc
& (IEEE80211_FCTL_TODS
| IEEE80211_FCTL_FROMDS
)) {
202 case IEEE80211_FCTL_TODS
:
204 case (IEEE80211_FCTL_TODS
| IEEE80211_FCTL_FROMDS
):
206 case IEEE80211_FCTL_FROMDS
:
212 case IEEE80211_FTYPE_MGMT
:
214 case IEEE80211_FTYPE_CTL
:
215 if ((fc
& IEEE80211_FCTL_STYPE
) == IEEE80211_STYPE_PSPOLL
)
224 int ieee80211_get_hdrlen(u16 fc
)
228 switch (fc
& IEEE80211_FCTL_FTYPE
) {
229 case IEEE80211_FTYPE_DATA
:
230 if ((fc
& IEEE80211_FCTL_FROMDS
) && (fc
& IEEE80211_FCTL_TODS
))
231 hdrlen
= 30; /* Addr4 */
233 * The QoS Control field is two bytes and its presence is
234 * indicated by the IEEE80211_STYPE_QOS_DATA bit. Add 2 to
235 * hdrlen if that bit is set.
236 * This works by masking out the bit and shifting it to
237 * bit position 1 so the result has the value 0 or 2.
239 hdrlen
+= (fc
& IEEE80211_STYPE_QOS_DATA
)
240 >> (ilog2(IEEE80211_STYPE_QOS_DATA
)-1);
242 case IEEE80211_FTYPE_CTL
:
244 * ACK and CTS are 10 bytes, all others 16. To see how
245 * to get this condition consider
246 * subtype mask: 0b0000000011110000 (0x00F0)
247 * ACK subtype: 0b0000000011010000 (0x00D0)
248 * CTS subtype: 0b0000000011000000 (0x00C0)
249 * bits that matter: ^^^ (0x00E0)
250 * value of those: 0b0000000011000000 (0x00C0)
252 if ((fc
& 0xE0) == 0xC0)
261 EXPORT_SYMBOL(ieee80211_get_hdrlen
);
263 int ieee80211_get_hdrlen_from_skb(const struct sk_buff
*skb
)
265 const struct ieee80211_hdr
*hdr
= (const struct ieee80211_hdr
*) skb
->data
;
268 if (unlikely(skb
->len
< 10))
270 hdrlen
= ieee80211_get_hdrlen(le16_to_cpu(hdr
->frame_control
));
271 if (unlikely(hdrlen
> skb
->len
))
275 EXPORT_SYMBOL(ieee80211_get_hdrlen_from_skb
);
278 int ieee80211_is_eapol(const struct sk_buff
*skb
)
280 const struct ieee80211_hdr
*hdr
;
284 if (unlikely(skb
->len
< 10))
287 hdr
= (const struct ieee80211_hdr
*) skb
->data
;
288 fc
= le16_to_cpu(hdr
->frame_control
);
290 if (unlikely(!WLAN_FC_DATA_PRESENT(fc
)))
293 hdrlen
= ieee80211_get_hdrlen(fc
);
295 if (unlikely(skb
->len
>= hdrlen
+ sizeof(eapol_header
) &&
296 memcmp(skb
->data
+ hdrlen
, eapol_header
,
297 sizeof(eapol_header
)) == 0))
304 void ieee80211_tx_set_iswep(struct ieee80211_txrx_data
*tx
)
306 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) tx
->skb
->data
;
308 hdr
->frame_control
|= cpu_to_le16(IEEE80211_FCTL_PROTECTED
);
309 if (tx
->u
.tx
.extra_frag
) {
310 struct ieee80211_hdr
*fhdr
;
312 for (i
= 0; i
< tx
->u
.tx
.num_extra_frag
; i
++) {
313 fhdr
= (struct ieee80211_hdr
*)
314 tx
->u
.tx
.extra_frag
[i
]->data
;
315 fhdr
->frame_control
|= cpu_to_le16(IEEE80211_FCTL_PROTECTED
);
321 static int ieee80211_frame_duration(struct ieee80211_local
*local
, size_t len
,
322 int rate
, int erp
, int short_preamble
)
326 /* calculate duration (in microseconds, rounded up to next higher
327 * integer if it includes a fractional microsecond) to send frame of
328 * len bytes (does not include FCS) at the given rate. Duration will
331 * rate is in 100 kbps, so divident is multiplied by 10 in the
332 * DIV_ROUND_UP() operations.
335 if (local
->hw
.conf
.phymode
== MODE_IEEE80211A
|| erp
||
336 local
->hw
.conf
.phymode
== MODE_ATHEROS_TURBO
) {
340 * N_DBPS = DATARATE x 4
341 * N_SYM = Ceiling((16+8xLENGTH+6) / N_DBPS)
342 * (16 = SIGNAL time, 6 = tail bits)
343 * TXTIME = T_PREAMBLE + T_SIGNAL + T_SYM x N_SYM + Signal Ext
346 * 802.11a - 17.5.2: aSIFSTime = 16 usec
347 * 802.11g - 19.8.4: aSIFSTime = 10 usec +
348 * signal ext = 6 usec
350 /* FIX: Atheros Turbo may have different (shorter) duration? */
351 dur
= 16; /* SIFS + signal ext */
352 dur
+= 16; /* 17.3.2.3: T_PREAMBLE = 16 usec */
353 dur
+= 4; /* 17.3.2.3: T_SIGNAL = 4 usec */
354 dur
+= 4 * DIV_ROUND_UP((16 + 8 * (len
+ 4) + 6) * 10,
355 4 * rate
); /* T_SYM x N_SYM */
358 * 802.11b or 802.11g with 802.11b compatibility:
359 * 18.3.4: TXTIME = PreambleLength + PLCPHeaderTime +
360 * Ceiling(((LENGTH+PBCC)x8)/DATARATE). PBCC=0.
362 * 802.11 (DS): 15.3.3, 802.11b: 18.3.4
363 * aSIFSTime = 10 usec
364 * aPreambleLength = 144 usec or 72 usec with short preamble
365 * aPLCPHeaderLength = 48 usec or 24 usec with short preamble
367 dur
= 10; /* aSIFSTime = 10 usec */
368 dur
+= short_preamble
? (72 + 24) : (144 + 48);
370 dur
+= DIV_ROUND_UP(8 * (len
+ 4) * 10, rate
);
377 /* Exported duration function for driver use */
378 __le16
ieee80211_generic_frame_duration(struct ieee80211_hw
*hw
,
379 size_t frame_len
, int rate
)
381 struct ieee80211_local
*local
= hw_to_local(hw
);
385 erp
= ieee80211_is_erp_rate(hw
->conf
.phymode
, rate
);
386 dur
= ieee80211_frame_duration(local
, frame_len
, rate
,
387 erp
, local
->short_preamble
);
389 return cpu_to_le16(dur
);
391 EXPORT_SYMBOL(ieee80211_generic_frame_duration
);
394 __le16
ieee80211_rts_duration(struct ieee80211_hw
*hw
,
396 const struct ieee80211_tx_control
*frame_txctl
)
398 struct ieee80211_local
*local
= hw_to_local(hw
);
399 struct ieee80211_rate
*rate
;
400 int short_preamble
= local
->short_preamble
;
404 rate
= frame_txctl
->rts_rate
;
405 erp
= !!(rate
->flags
& IEEE80211_RATE_ERP
);
408 dur
= ieee80211_frame_duration(local
, 10, rate
->rate
,
409 erp
, short_preamble
);
410 /* Data frame duration */
411 dur
+= ieee80211_frame_duration(local
, frame_len
, rate
->rate
,
412 erp
, short_preamble
);
414 dur
+= ieee80211_frame_duration(local
, 10, rate
->rate
,
415 erp
, short_preamble
);
417 return cpu_to_le16(dur
);
419 EXPORT_SYMBOL(ieee80211_rts_duration
);
422 __le16
ieee80211_ctstoself_duration(struct ieee80211_hw
*hw
,
424 const struct ieee80211_tx_control
*frame_txctl
)
426 struct ieee80211_local
*local
= hw_to_local(hw
);
427 struct ieee80211_rate
*rate
;
428 int short_preamble
= local
->short_preamble
;
432 rate
= frame_txctl
->rts_rate
;
433 erp
= !!(rate
->flags
& IEEE80211_RATE_ERP
);
435 /* Data frame duration */
436 dur
= ieee80211_frame_duration(local
, frame_len
, rate
->rate
,
437 erp
, short_preamble
);
438 if (!(frame_txctl
->flags
& IEEE80211_TXCTL_NO_ACK
)) {
440 dur
+= ieee80211_frame_duration(local
, 10, rate
->rate
,
441 erp
, short_preamble
);
444 return cpu_to_le16(dur
);
446 EXPORT_SYMBOL(ieee80211_ctstoself_duration
);
448 static int __ieee80211_if_config(struct net_device
*dev
,
449 struct sk_buff
*beacon
,
450 struct ieee80211_tx_control
*control
)
452 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
453 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
454 struct ieee80211_if_conf conf
;
455 static u8 scan_bssid
[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
457 if (!local
->ops
->config_interface
|| !netif_running(dev
))
460 memset(&conf
, 0, sizeof(conf
));
461 conf
.type
= sdata
->type
;
462 if (sdata
->type
== IEEE80211_IF_TYPE_STA
||
463 sdata
->type
== IEEE80211_IF_TYPE_IBSS
) {
464 if (local
->sta_scanning
&&
465 local
->scan_dev
== dev
)
466 conf
.bssid
= scan_bssid
;
468 conf
.bssid
= sdata
->u
.sta
.bssid
;
469 conf
.ssid
= sdata
->u
.sta
.ssid
;
470 conf
.ssid_len
= sdata
->u
.sta
.ssid_len
;
471 conf
.generic_elem
= sdata
->u
.sta
.extra_ie
;
472 conf
.generic_elem_len
= sdata
->u
.sta
.extra_ie_len
;
473 } else if (sdata
->type
== IEEE80211_IF_TYPE_AP
) {
474 conf
.ssid
= sdata
->u
.ap
.ssid
;
475 conf
.ssid_len
= sdata
->u
.ap
.ssid_len
;
476 conf
.generic_elem
= sdata
->u
.ap
.generic_elem
;
477 conf
.generic_elem_len
= sdata
->u
.ap
.generic_elem_len
;
478 conf
.beacon
= beacon
;
479 conf
.beacon_control
= control
;
481 return local
->ops
->config_interface(local_to_hw(local
),
482 dev
->ifindex
, &conf
);
485 int ieee80211_if_config(struct net_device
*dev
)
487 return __ieee80211_if_config(dev
, NULL
, NULL
);
490 int ieee80211_if_config_beacon(struct net_device
*dev
)
492 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
493 struct ieee80211_tx_control control
;
496 if (!(local
->hw
.flags
& IEEE80211_HW_HOST_GEN_BEACON_TEMPLATE
))
498 skb
= ieee80211_beacon_get(local_to_hw(local
), dev
->ifindex
, &control
);
501 return __ieee80211_if_config(dev
, skb
, &control
);
504 int ieee80211_hw_config(struct ieee80211_local
*local
)
506 struct ieee80211_hw_mode
*mode
;
507 struct ieee80211_channel
*chan
;
510 if (local
->sta_scanning
) {
511 chan
= local
->scan_channel
;
512 mode
= local
->scan_hw_mode
;
514 chan
= local
->oper_channel
;
515 mode
= local
->oper_hw_mode
;
518 local
->hw
.conf
.channel
= chan
->chan
;
519 local
->hw
.conf
.channel_val
= chan
->val
;
520 local
->hw
.conf
.power_level
= chan
->power_level
;
521 local
->hw
.conf
.freq
= chan
->freq
;
522 local
->hw
.conf
.phymode
= mode
->mode
;
523 local
->hw
.conf
.antenna_max
= chan
->antenna_max
;
524 local
->hw
.conf
.chan
= chan
;
525 local
->hw
.conf
.mode
= mode
;
527 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
528 printk(KERN_DEBUG
"HW CONFIG: channel=%d freq=%d "
529 "phymode=%d\n", local
->hw
.conf
.channel
, local
->hw
.conf
.freq
,
530 local
->hw
.conf
.phymode
);
531 #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
533 if (local
->ops
->config
)
534 ret
= local
->ops
->config(local_to_hw(local
), &local
->hw
.conf
);
540 static int ieee80211_change_mtu(struct net_device
*dev
, int new_mtu
)
542 /* FIX: what would be proper limits for MTU?
543 * This interface uses 802.3 frames. */
544 if (new_mtu
< 256 || new_mtu
> IEEE80211_MAX_DATA_LEN
- 24 - 6) {
545 printk(KERN_WARNING
"%s: invalid MTU %d\n",
550 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
551 printk(KERN_DEBUG
"%s: setting MTU %d\n", dev
->name
, new_mtu
);
552 #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
558 static int ieee80211_change_mtu_apdev(struct net_device
*dev
, int new_mtu
)
560 /* FIX: what would be proper limits for MTU?
561 * This interface uses 802.11 frames. */
562 if (new_mtu
< 256 || new_mtu
> IEEE80211_MAX_DATA_LEN
) {
563 printk(KERN_WARNING
"%s: invalid MTU %d\n",
568 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
569 printk(KERN_DEBUG
"%s: setting MTU %d\n", dev
->name
, new_mtu
);
570 #endif /* CONFIG_MAC80211_VERBOSE_DEBUG */
575 enum netif_tx_lock_class
{
580 static inline void netif_tx_lock_nested(struct net_device
*dev
, int subclass
)
582 spin_lock_nested(&dev
->_xmit_lock
, subclass
);
583 dev
->xmit_lock_owner
= smp_processor_id();
586 static void ieee80211_set_multicast_list(struct net_device
*dev
)
588 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
589 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
590 unsigned short flags
;
592 netif_tx_lock_nested(local
->mdev
, TX_LOCK_MASTER
);
593 if (((dev
->flags
& IFF_ALLMULTI
) != 0) ^ (sdata
->allmulti
!= 0)) {
594 if (sdata
->allmulti
) {
596 local
->iff_allmultis
--;
599 local
->iff_allmultis
++;
602 if (((dev
->flags
& IFF_PROMISC
) != 0) ^ (sdata
->promisc
!= 0)) {
603 if (sdata
->promisc
) {
605 local
->iff_promiscs
--;
608 local
->iff_promiscs
++;
611 if (dev
->mc_count
!= sdata
->mc_count
) {
612 local
->mc_count
= local
->mc_count
- sdata
->mc_count
+
614 sdata
->mc_count
= dev
->mc_count
;
616 if (local
->ops
->set_multicast_list
) {
617 flags
= local
->mdev
->flags
;
618 if (local
->iff_allmultis
)
619 flags
|= IFF_ALLMULTI
;
620 if (local
->iff_promiscs
)
621 flags
|= IFF_PROMISC
;
622 read_lock(&local
->sub_if_lock
);
623 local
->ops
->set_multicast_list(local_to_hw(local
), flags
,
625 read_unlock(&local
->sub_if_lock
);
627 netif_tx_unlock(local
->mdev
);
630 struct dev_mc_list
*ieee80211_get_mc_list_item(struct ieee80211_hw
*hw
,
631 struct dev_mc_list
*prev
,
634 struct ieee80211_local
*local
= hw_to_local(hw
);
635 struct ieee80211_sub_if_data
*sdata
= *ptr
;
636 struct dev_mc_list
*mc
;
642 if (!prev
|| !prev
->next
) {
644 sdata
= list_entry(sdata
->list
.next
,
645 struct ieee80211_sub_if_data
, list
);
647 sdata
= list_entry(local
->sub_if_list
.next
,
648 struct ieee80211_sub_if_data
, list
);
649 if (&sdata
->list
!= &local
->sub_if_list
)
650 mc
= sdata
->dev
->mc_list
;
659 EXPORT_SYMBOL(ieee80211_get_mc_list_item
);
661 static struct net_device_stats
*ieee80211_get_stats(struct net_device
*dev
)
663 struct ieee80211_sub_if_data
*sdata
;
664 sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
665 return &(sdata
->stats
);
668 static void ieee80211_if_shutdown(struct net_device
*dev
)
670 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
671 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
674 switch (sdata
->type
) {
675 case IEEE80211_IF_TYPE_STA
:
676 case IEEE80211_IF_TYPE_IBSS
:
677 sdata
->u
.sta
.state
= IEEE80211_DISABLED
;
678 del_timer_sync(&sdata
->u
.sta
.timer
);
679 skb_queue_purge(&sdata
->u
.sta
.skb_queue
);
680 if (!local
->ops
->hw_scan
&&
681 local
->scan_dev
== sdata
->dev
) {
682 local
->sta_scanning
= 0;
683 cancel_delayed_work(&local
->scan_work
);
685 flush_workqueue(local
->hw
.workqueue
);
690 static inline int identical_mac_addr_allowed(int type1
, int type2
)
692 return (type1
== IEEE80211_IF_TYPE_MNTR
||
693 type2
== IEEE80211_IF_TYPE_MNTR
||
694 (type1
== IEEE80211_IF_TYPE_AP
&&
695 type2
== IEEE80211_IF_TYPE_WDS
) ||
696 (type1
== IEEE80211_IF_TYPE_WDS
&&
697 (type2
== IEEE80211_IF_TYPE_WDS
||
698 type2
== IEEE80211_IF_TYPE_AP
)) ||
699 (type1
== IEEE80211_IF_TYPE_AP
&&
700 type2
== IEEE80211_IF_TYPE_VLAN
) ||
701 (type1
== IEEE80211_IF_TYPE_VLAN
&&
702 (type2
== IEEE80211_IF_TYPE_AP
||
703 type2
== IEEE80211_IF_TYPE_VLAN
)));
706 static int ieee80211_master_open(struct net_device
*dev
)
708 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
709 struct ieee80211_sub_if_data
*sdata
;
710 int res
= -EOPNOTSUPP
;
712 read_lock(&local
->sub_if_lock
);
713 list_for_each_entry(sdata
, &local
->sub_if_list
, list
) {
714 if (sdata
->dev
!= dev
&& netif_running(sdata
->dev
)) {
719 read_unlock(&local
->sub_if_lock
);
723 static int ieee80211_master_stop(struct net_device
*dev
)
725 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
726 struct ieee80211_sub_if_data
*sdata
;
728 read_lock(&local
->sub_if_lock
);
729 list_for_each_entry(sdata
, &local
->sub_if_list
, list
)
730 if (sdata
->dev
!= dev
&& netif_running(sdata
->dev
))
731 dev_close(sdata
->dev
);
732 read_unlock(&local
->sub_if_lock
);
737 static int ieee80211_mgmt_open(struct net_device
*dev
)
739 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
741 if (!netif_running(local
->mdev
))
746 static int ieee80211_mgmt_stop(struct net_device
*dev
)
751 /* Check if running monitor interfaces should go to a "soft monitor" mode
752 * and switch them if necessary. */
753 static inline void ieee80211_start_soft_monitor(struct ieee80211_local
*local
)
755 struct ieee80211_if_init_conf conf
;
757 if (local
->open_count
&& local
->open_count
== local
->monitors
&&
758 !(local
->hw
.flags
& IEEE80211_HW_MONITOR_DURING_OPER
) &&
759 local
->ops
->remove_interface
) {
761 conf
.type
= IEEE80211_IF_TYPE_MNTR
;
762 conf
.mac_addr
= NULL
;
763 local
->ops
->remove_interface(local_to_hw(local
), &conf
);
767 /* Check if running monitor interfaces should go to a "hard monitor" mode
768 * and switch them if necessary. */
769 static void ieee80211_start_hard_monitor(struct ieee80211_local
*local
)
771 struct ieee80211_if_init_conf conf
;
773 if (local
->open_count
&& local
->open_count
== local
->monitors
&&
774 !(local
->hw
.flags
& IEEE80211_HW_MONITOR_DURING_OPER
)) {
776 conf
.type
= IEEE80211_IF_TYPE_MNTR
;
777 conf
.mac_addr
= NULL
;
778 local
->ops
->add_interface(local_to_hw(local
), &conf
);
782 static int ieee80211_open(struct net_device
*dev
)
784 struct ieee80211_sub_if_data
*sdata
, *nsdata
;
785 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
786 struct ieee80211_if_init_conf conf
;
789 sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
790 read_lock(&local
->sub_if_lock
);
791 list_for_each_entry(nsdata
, &local
->sub_if_list
, list
) {
792 struct net_device
*ndev
= nsdata
->dev
;
794 if (ndev
!= dev
&& ndev
!= local
->mdev
&& netif_running(ndev
) &&
795 compare_ether_addr(dev
->dev_addr
, ndev
->dev_addr
) == 0 &&
796 !identical_mac_addr_allowed(sdata
->type
, nsdata
->type
)) {
797 read_unlock(&local
->sub_if_lock
);
801 read_unlock(&local
->sub_if_lock
);
803 if (sdata
->type
== IEEE80211_IF_TYPE_WDS
&&
804 is_zero_ether_addr(sdata
->u
.wds
.remote_addr
))
807 if (sdata
->type
== IEEE80211_IF_TYPE_MNTR
&& local
->open_count
&&
808 !(local
->hw
.flags
& IEEE80211_HW_MONITOR_DURING_OPER
)) {
809 /* run the interface in a "soft monitor" mode */
812 local
->hw
.conf
.flags
|= IEEE80211_CONF_RADIOTAP
;
815 ieee80211_start_soft_monitor(local
);
817 conf
.if_id
= dev
->ifindex
;
818 conf
.type
= sdata
->type
;
819 conf
.mac_addr
= dev
->dev_addr
;
820 res
= local
->ops
->add_interface(local_to_hw(local
), &conf
);
822 if (sdata
->type
== IEEE80211_IF_TYPE_MNTR
)
823 ieee80211_start_hard_monitor(local
);
827 if (local
->open_count
== 0) {
829 tasklet_enable(&local
->tx_pending_tasklet
);
830 tasklet_enable(&local
->tasklet
);
831 if (local
->ops
->open
)
832 res
= local
->ops
->open(local_to_hw(local
));
834 res
= dev_open(local
->mdev
);
836 if (local
->ops
->stop
)
837 local
->ops
->stop(local_to_hw(local
));
839 res
= ieee80211_hw_config(local
);
840 if (res
&& local
->ops
->stop
)
841 local
->ops
->stop(local_to_hw(local
));
842 else if (!res
&& local
->apdev
)
843 dev_open(local
->apdev
);
847 if (local
->ops
->remove_interface
)
848 local
->ops
->remove_interface(local_to_hw(local
),
855 if (sdata
->type
== IEEE80211_IF_TYPE_MNTR
) {
857 local
->hw
.conf
.flags
|= IEEE80211_CONF_RADIOTAP
;
859 ieee80211_if_config(dev
);
861 if (sdata
->type
== IEEE80211_IF_TYPE_STA
&&
862 !local
->user_space_mlme
)
863 netif_carrier_off(dev
);
865 netif_carrier_on(dev
);
867 netif_start_queue(dev
);
872 static int ieee80211_stop(struct net_device
*dev
)
874 struct ieee80211_sub_if_data
*sdata
;
875 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
877 sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
879 if (sdata
->type
== IEEE80211_IF_TYPE_MNTR
&&
880 local
->open_count
> 1 &&
881 !(local
->hw
.flags
& IEEE80211_HW_MONITOR_DURING_OPER
)) {
882 /* remove "soft monitor" interface */
885 if (!local
->monitors
)
886 local
->hw
.conf
.flags
&= ~IEEE80211_CONF_RADIOTAP
;
890 netif_stop_queue(dev
);
891 ieee80211_if_shutdown(dev
);
893 if (sdata
->type
== IEEE80211_IF_TYPE_MNTR
) {
895 if (!local
->monitors
)
896 local
->hw
.conf
.flags
&= ~IEEE80211_CONF_RADIOTAP
;
900 if (local
->open_count
== 0) {
901 if (netif_running(local
->mdev
))
902 dev_close(local
->mdev
);
904 dev_close(local
->apdev
);
905 if (local
->ops
->stop
)
906 local
->ops
->stop(local_to_hw(local
));
907 tasklet_disable(&local
->tx_pending_tasklet
);
908 tasklet_disable(&local
->tasklet
);
910 if (local
->ops
->remove_interface
) {
911 struct ieee80211_if_init_conf conf
;
913 conf
.if_id
= dev
->ifindex
;
914 conf
.type
= sdata
->type
;
915 conf
.mac_addr
= dev
->dev_addr
;
916 local
->ops
->remove_interface(local_to_hw(local
), &conf
);
919 ieee80211_start_hard_monitor(local
);
925 static int header_parse_80211(struct sk_buff
*skb
, unsigned char *haddr
)
927 memcpy(haddr
, skb_mac_header(skb
) + 10, ETH_ALEN
); /* addr2 */
931 struct ieee80211_rate
*
932 ieee80211_get_rate(struct ieee80211_local
*local
, int phymode
, int hw_rate
)
934 struct ieee80211_hw_mode
*mode
;
937 list_for_each_entry(mode
, &local
->modes_list
, list
) {
938 if (mode
->mode
!= phymode
)
940 for (r
= 0; r
< mode
->num_rates
; r
++) {
941 struct ieee80211_rate
*rate
= &mode
->rates
[r
];
942 if (rate
->val
== hw_rate
||
943 (rate
->flags
& IEEE80211_RATE_PREAMBLE2
&&
944 rate
->val2
== hw_rate
))
953 ieee80211_fill_frame_info(struct ieee80211_local
*local
,
954 struct ieee80211_frame_info
*fi
,
955 struct ieee80211_rx_status
*status
)
959 struct ieee80211_rate
*rate
;
961 jiffies_to_timespec(jiffies
, &ts
);
962 fi
->hosttime
= cpu_to_be64((u64
) ts
.tv_sec
* 1000000 +
964 fi
->mactime
= cpu_to_be64(status
->mactime
);
965 switch (status
->phymode
) {
966 case MODE_IEEE80211A
:
967 fi
->phytype
= htonl(ieee80211_phytype_ofdm_dot11_a
);
969 case MODE_IEEE80211B
:
970 fi
->phytype
= htonl(ieee80211_phytype_dsss_dot11_b
);
972 case MODE_IEEE80211G
:
973 fi
->phytype
= htonl(ieee80211_phytype_pbcc_dot11_g
);
975 case MODE_ATHEROS_TURBO
:
977 htonl(ieee80211_phytype_dsss_dot11_turbo
);
980 fi
->phytype
= htonl(0xAAAAAAAA);
983 fi
->channel
= htonl(status
->channel
);
984 rate
= ieee80211_get_rate(local
, status
->phymode
,
987 fi
->datarate
= htonl(rate
->rate
);
988 if (rate
->flags
& IEEE80211_RATE_PREAMBLE2
) {
989 if (status
->rate
== rate
->val
)
990 fi
->preamble
= htonl(2); /* long */
991 else if (status
->rate
== rate
->val2
)
992 fi
->preamble
= htonl(1); /* short */
994 fi
->preamble
= htonl(0);
996 fi
->datarate
= htonl(0);
997 fi
->preamble
= htonl(0);
1000 fi
->antenna
= htonl(status
->antenna
);
1001 fi
->priority
= htonl(0xffffffff); /* no clue */
1002 fi
->ssi_type
= htonl(ieee80211_ssi_raw
);
1003 fi
->ssi_signal
= htonl(status
->ssi
);
1004 fi
->ssi_noise
= 0x00000000;
1007 /* clear everything because we really don't know.
1008 * the msg_type field isn't present on monitor frames
1009 * so we don't know whether it will be present or not,
1010 * but it's ok to not clear it since it'll be assigned
1012 memset(fi
, 0, sizeof(*fi
) - sizeof(fi
->msg_type
));
1014 fi
->ssi_type
= htonl(ieee80211_ssi_none
);
1016 fi
->version
= htonl(IEEE80211_FI_VERSION
);
1017 fi
->length
= cpu_to_be32(sizeof(*fi
) - sizeof(fi
->msg_type
));
1020 /* this routine is actually not just for this, but also
1021 * for pushing fake 'management' frames into userspace.
1022 * it shall be replaced by a netlink-based system. */
1024 ieee80211_rx_mgmt(struct ieee80211_local
*local
, struct sk_buff
*skb
,
1025 struct ieee80211_rx_status
*status
, u32 msg_type
)
1027 struct ieee80211_frame_info
*fi
;
1028 const size_t hlen
= sizeof(struct ieee80211_frame_info
);
1029 struct ieee80211_sub_if_data
*sdata
;
1031 skb
->dev
= local
->apdev
;
1033 sdata
= IEEE80211_DEV_TO_SUB_IF(local
->apdev
);
1035 if (skb_headroom(skb
) < hlen
) {
1036 I802_DEBUG_INC(local
->rx_expand_skb_head
);
1037 if (pskb_expand_head(skb
, hlen
, 0, GFP_ATOMIC
)) {
1043 fi
= (struct ieee80211_frame_info
*) skb_push(skb
, hlen
);
1045 ieee80211_fill_frame_info(local
, fi
, status
);
1046 fi
->msg_type
= htonl(msg_type
);
1048 sdata
->stats
.rx_packets
++;
1049 sdata
->stats
.rx_bytes
+= skb
->len
;
1051 skb_set_mac_header(skb
, 0);
1052 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
1053 skb
->pkt_type
= PACKET_OTHERHOST
;
1054 skb
->protocol
= htons(ETH_P_802_2
);
1055 memset(skb
->cb
, 0, sizeof(skb
->cb
));
1059 int ieee80211_radar_status(struct ieee80211_hw
*hw
, int channel
,
1060 int radar
, int radar_type
)
1062 struct sk_buff
*skb
;
1063 struct ieee80211_radar_info
*msg
;
1064 struct ieee80211_local
*local
= hw_to_local(hw
);
1069 skb
= dev_alloc_skb(sizeof(struct ieee80211_frame_info
) +
1070 sizeof(struct ieee80211_radar_info
));
1074 skb_reserve(skb
, sizeof(struct ieee80211_frame_info
));
1076 msg
= (struct ieee80211_radar_info
*)
1077 skb_put(skb
, sizeof(struct ieee80211_radar_info
));
1078 msg
->channel
= channel
;
1080 msg
->radar_type
= radar_type
;
1082 ieee80211_rx_mgmt(local
, skb
, NULL
, ieee80211_msg_radar
);
1085 EXPORT_SYMBOL(ieee80211_radar_status
);
1088 static void ieee80211_stat_refresh(unsigned long data
)
1090 struct ieee80211_local
*local
= (struct ieee80211_local
*) data
;
1091 struct sta_info
*sta
;
1092 struct ieee80211_sub_if_data
*sdata
;
1094 if (!local
->stat_time
)
1097 /* go through all stations */
1098 spin_lock_bh(&local
->sta_lock
);
1099 list_for_each_entry(sta
, &local
->sta_list
, list
) {
1100 sta
->channel_use
= (sta
->channel_use_raw
/ local
->stat_time
) /
1102 sta
->channel_use_raw
= 0;
1104 spin_unlock_bh(&local
->sta_lock
);
1106 /* go through all subinterfaces */
1107 read_lock(&local
->sub_if_lock
);
1108 list_for_each_entry(sdata
, &local
->sub_if_list
, list
) {
1109 sdata
->channel_use
= (sdata
->channel_use_raw
/
1110 local
->stat_time
) / CHAN_UTIL_PER_10MS
;
1111 sdata
->channel_use_raw
= 0;
1113 read_unlock(&local
->sub_if_lock
);
1115 /* hardware interface */
1116 local
->channel_use
= (local
->channel_use_raw
/
1117 local
->stat_time
) / CHAN_UTIL_PER_10MS
;
1118 local
->channel_use_raw
= 0;
1120 local
->stat_timer
.expires
= jiffies
+ HZ
* local
->stat_time
/ 100;
1121 add_timer(&local
->stat_timer
);
1125 void ieee80211_tx_status_irqsafe(struct ieee80211_hw
*hw
,
1126 struct sk_buff
*skb
,
1127 struct ieee80211_tx_status
*status
)
1129 struct ieee80211_local
*local
= hw_to_local(hw
);
1130 struct ieee80211_tx_status
*saved
;
1133 skb
->dev
= local
->mdev
;
1134 saved
= kmalloc(sizeof(struct ieee80211_tx_status
), GFP_ATOMIC
);
1135 if (unlikely(!saved
)) {
1136 if (net_ratelimit())
1137 printk(KERN_WARNING
"%s: Not enough memory, "
1138 "dropping tx status", skb
->dev
->name
);
1139 /* should be dev_kfree_skb_irq, but due to this function being
1140 * named _irqsafe instead of just _irq we can't be sure that
1141 * people won't call it from non-irq contexts */
1142 dev_kfree_skb_any(skb
);
1145 memcpy(saved
, status
, sizeof(struct ieee80211_tx_status
));
1146 /* copy pointer to saved status into skb->cb for use by tasklet */
1147 memcpy(skb
->cb
, &saved
, sizeof(saved
));
1149 skb
->pkt_type
= IEEE80211_TX_STATUS_MSG
;
1150 skb_queue_tail(status
->control
.flags
& IEEE80211_TXCTL_REQ_TX_STATUS
?
1151 &local
->skb_queue
: &local
->skb_queue_unreliable
, skb
);
1152 tmp
= skb_queue_len(&local
->skb_queue
) +
1153 skb_queue_len(&local
->skb_queue_unreliable
);
1154 while (tmp
> IEEE80211_IRQSAFE_QUEUE_LIMIT
&&
1155 (skb
= skb_dequeue(&local
->skb_queue_unreliable
))) {
1156 memcpy(&saved
, skb
->cb
, sizeof(saved
));
1158 dev_kfree_skb_irq(skb
);
1160 I802_DEBUG_INC(local
->tx_status_drop
);
1162 tasklet_schedule(&local
->tasklet
);
1164 EXPORT_SYMBOL(ieee80211_tx_status_irqsafe
);
1166 static void ieee80211_tasklet_handler(unsigned long data
)
1168 struct ieee80211_local
*local
= (struct ieee80211_local
*) data
;
1169 struct sk_buff
*skb
;
1170 struct ieee80211_rx_status rx_status
;
1171 struct ieee80211_tx_status
*tx_status
;
1173 while ((skb
= skb_dequeue(&local
->skb_queue
)) ||
1174 (skb
= skb_dequeue(&local
->skb_queue_unreliable
))) {
1175 switch (skb
->pkt_type
) {
1176 case IEEE80211_RX_MSG
:
1177 /* status is in skb->cb */
1178 memcpy(&rx_status
, skb
->cb
, sizeof(rx_status
));
1179 /* Clear skb->type in order to not confuse kernel
1182 __ieee80211_rx(local_to_hw(local
), skb
, &rx_status
);
1184 case IEEE80211_TX_STATUS_MSG
:
1185 /* get pointer to saved status out of skb->cb */
1186 memcpy(&tx_status
, skb
->cb
, sizeof(tx_status
));
1188 ieee80211_tx_status(local_to_hw(local
),
1192 default: /* should never get here! */
1193 printk(KERN_ERR
"%s: Unknown message type (%d)\n",
1194 local
->mdev
->name
, skb
->pkt_type
);
1202 /* Remove added headers (e.g., QoS control), encryption header/MIC, etc. to
1203 * make a prepared TX frame (one that has been given to hw) to look like brand
1204 * new IEEE 802.11 frame that is ready to go through TX processing again.
1205 * Also, tx_packet_data in cb is restored from tx_control. */
1206 static void ieee80211_remove_tx_extra(struct ieee80211_local
*local
,
1207 struct ieee80211_key
*key
,
1208 struct sk_buff
*skb
,
1209 struct ieee80211_tx_control
*control
)
1211 int hdrlen
, iv_len
, mic_len
;
1212 struct ieee80211_tx_packet_data
*pkt_data
;
1214 pkt_data
= (struct ieee80211_tx_packet_data
*)skb
->cb
;
1215 pkt_data
->ifindex
= control
->ifindex
;
1216 pkt_data
->mgmt_iface
= (control
->type
== IEEE80211_IF_TYPE_MGMT
);
1217 pkt_data
->req_tx_status
= !!(control
->flags
& IEEE80211_TXCTL_REQ_TX_STATUS
);
1218 pkt_data
->do_not_encrypt
= !!(control
->flags
& IEEE80211_TXCTL_DO_NOT_ENCRYPT
);
1219 pkt_data
->requeue
= !!(control
->flags
& IEEE80211_TXCTL_REQUEUE
);
1220 pkt_data
->queue
= control
->queue
;
1222 hdrlen
= ieee80211_get_hdrlen_from_skb(skb
);
1229 iv_len
= WEP_IV_LEN
;
1230 mic_len
= WEP_ICV_LEN
;
1233 iv_len
= TKIP_IV_LEN
;
1234 mic_len
= TKIP_ICV_LEN
;
1237 iv_len
= CCMP_HDR_LEN
;
1238 mic_len
= CCMP_MIC_LEN
;
1244 if (skb
->len
>= mic_len
&& key
->force_sw_encrypt
)
1245 skb_trim(skb
, skb
->len
- mic_len
);
1246 if (skb
->len
>= iv_len
&& skb
->len
> hdrlen
) {
1247 memmove(skb
->data
+ iv_len
, skb
->data
, hdrlen
);
1248 skb_pull(skb
, iv_len
);
1253 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) skb
->data
;
1254 u16 fc
= le16_to_cpu(hdr
->frame_control
);
1255 if ((fc
& 0x8C) == 0x88) /* QoS Control Field */ {
1256 fc
&= ~IEEE80211_STYPE_QOS_DATA
;
1257 hdr
->frame_control
= cpu_to_le16(fc
);
1258 memmove(skb
->data
+ 2, skb
->data
, hdrlen
- 2);
1265 void ieee80211_tx_status(struct ieee80211_hw
*hw
, struct sk_buff
*skb
,
1266 struct ieee80211_tx_status
*status
)
1268 struct sk_buff
*skb2
;
1269 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) skb
->data
;
1270 struct ieee80211_local
*local
= hw_to_local(hw
);
1273 struct ieee80211_tx_status_rtap_hdr
*rthdr
;
1274 struct ieee80211_sub_if_data
*sdata
;
1279 "%s: ieee80211_tx_status called with NULL status\n",
1285 if (status
->excessive_retries
) {
1286 struct sta_info
*sta
;
1287 sta
= sta_info_get(local
, hdr
->addr1
);
1289 if (sta
->flags
& WLAN_STA_PS
) {
1290 /* The STA is in power save mode, so assume
1291 * that this TX packet failed because of that.
1293 status
->excessive_retries
= 0;
1294 status
->flags
|= IEEE80211_TX_STATUS_TX_FILTERED
;
1300 if (status
->flags
& IEEE80211_TX_STATUS_TX_FILTERED
) {
1301 struct sta_info
*sta
;
1302 sta
= sta_info_get(local
, hdr
->addr1
);
1304 sta
->tx_filtered_count
++;
1306 /* Clear the TX filter mask for this STA when sending
1307 * the next packet. If the STA went to power save mode,
1308 * this will happen when it is waking up for the next
1310 sta
->clear_dst_mask
= 1;
1312 /* TODO: Is the WLAN_STA_PS flag always set here or is
1313 * the race between RX and TX status causing some
1314 * packets to be filtered out before 80211.o gets an
1315 * update for PS status? This seems to be the case, so
1316 * no changes are likely to be needed. */
1317 if (sta
->flags
& WLAN_STA_PS
&&
1318 skb_queue_len(&sta
->tx_filtered
) <
1319 STA_MAX_TX_BUFFER
) {
1320 ieee80211_remove_tx_extra(local
, sta
->key
,
1323 skb_queue_tail(&sta
->tx_filtered
, skb
);
1324 } else if (!(sta
->flags
& WLAN_STA_PS
) &&
1325 !(status
->control
.flags
& IEEE80211_TXCTL_REQUEUE
)) {
1326 /* Software retry the packet once */
1327 status
->control
.flags
|= IEEE80211_TXCTL_REQUEUE
;
1328 ieee80211_remove_tx_extra(local
, sta
->key
,
1331 dev_queue_xmit(skb
);
1333 if (net_ratelimit()) {
1334 printk(KERN_DEBUG
"%s: dropped TX "
1335 "filtered frame queue_len=%d "
1340 !!(sta
->flags
& WLAN_STA_PS
),
1349 /* FIXME: STUPID to call this with both local and local->mdev */
1350 rate_control_tx_status(local
, local
->mdev
, skb
, status
);
1353 ieee80211_led_tx(local
, 0);
1356 * Fragments are passed to low-level drivers as separate skbs, so these
1357 * are actually fragments, not frames. Update frame counters only for
1358 * the first fragment of the frame. */
1360 frag
= le16_to_cpu(hdr
->seq_ctrl
) & IEEE80211_SCTL_FRAG
;
1361 type
= le16_to_cpu(hdr
->frame_control
) & IEEE80211_FCTL_FTYPE
;
1363 if (status
->flags
& IEEE80211_TX_STATUS_ACK
) {
1365 local
->dot11TransmittedFrameCount
++;
1366 if (is_multicast_ether_addr(hdr
->addr1
))
1367 local
->dot11MulticastTransmittedFrameCount
++;
1368 if (status
->retry_count
> 0)
1369 local
->dot11RetryCount
++;
1370 if (status
->retry_count
> 1)
1371 local
->dot11MultipleRetryCount
++;
1374 /* This counter shall be incremented for an acknowledged MPDU
1375 * with an individual address in the address 1 field or an MPDU
1376 * with a multicast address in the address 1 field of type Data
1378 if (!is_multicast_ether_addr(hdr
->addr1
) ||
1379 type
== IEEE80211_FTYPE_DATA
||
1380 type
== IEEE80211_FTYPE_MGMT
)
1381 local
->dot11TransmittedFragmentCount
++;
1384 local
->dot11FailedCount
++;
1387 msg_type
= (status
->flags
& IEEE80211_TX_STATUS_ACK
) ?
1388 ieee80211_msg_tx_callback_ack
: ieee80211_msg_tx_callback_fail
;
1390 /* this was a transmitted frame, but now we want to reuse it */
1393 if ((status
->control
.flags
& IEEE80211_TXCTL_REQ_TX_STATUS
) &&
1395 if (local
->monitors
) {
1396 skb2
= skb_clone(skb
, GFP_ATOMIC
);
1403 /* Send frame to hostapd */
1404 ieee80211_rx_mgmt(local
, skb2
, NULL
, msg_type
);
1410 if (!local
->monitors
) {
1415 /* send frame to monitor interfaces now */
1417 if (skb_headroom(skb
) < sizeof(*rthdr
)) {
1418 printk(KERN_ERR
"ieee80211_tx_status: headroom too small\n");
1423 rthdr
= (struct ieee80211_tx_status_rtap_hdr
*)
1424 skb_push(skb
, sizeof(*rthdr
));
1426 memset(rthdr
, 0, sizeof(*rthdr
));
1427 rthdr
->hdr
.it_len
= cpu_to_le16(sizeof(*rthdr
));
1428 rthdr
->hdr
.it_present
=
1429 cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS
) |
1430 (1 << IEEE80211_RADIOTAP_DATA_RETRIES
));
1432 if (!(status
->flags
& IEEE80211_TX_STATUS_ACK
) &&
1433 !is_multicast_ether_addr(hdr
->addr1
))
1434 rthdr
->tx_flags
|= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_FAIL
);
1436 if ((status
->control
.flags
& IEEE80211_TXCTL_USE_RTS_CTS
) &&
1437 (status
->control
.flags
& IEEE80211_TXCTL_USE_CTS_PROTECT
))
1438 rthdr
->tx_flags
|= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_CTS
);
1439 else if (status
->control
.flags
& IEEE80211_TXCTL_USE_RTS_CTS
)
1440 rthdr
->tx_flags
|= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_RTS
);
1442 rthdr
->data_retries
= status
->retry_count
;
1444 read_lock(&local
->sub_if_lock
);
1445 monitors
= local
->monitors
;
1446 list_for_each_entry(sdata
, &local
->sub_if_list
, list
) {
1448 * Using the monitors counter is possibly racy, but
1449 * if the value is wrong we simply either clone the skb
1450 * once too much or forget sending it to one monitor iface
1451 * The latter case isn't nice but fixing the race is much
1454 if (!monitors
|| !skb
)
1457 if (sdata
->type
== IEEE80211_IF_TYPE_MNTR
) {
1458 if (!netif_running(sdata
->dev
))
1462 skb2
= skb_clone(skb
, GFP_KERNEL
);
1465 skb
->dev
= sdata
->dev
;
1466 /* XXX: is this sufficient for BPF? */
1467 skb_set_mac_header(skb
, 0);
1468 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
1469 skb
->pkt_type
= PACKET_OTHERHOST
;
1470 skb
->protocol
= htons(ETH_P_802_2
);
1471 memset(skb
->cb
, 0, sizeof(skb
->cb
));
1477 read_unlock(&local
->sub_if_lock
);
1481 EXPORT_SYMBOL(ieee80211_tx_status
);
1484 int ieee80211_if_update_wds(struct net_device
*dev
, u8
*remote_addr
)
1486 struct ieee80211_local
*local
= wdev_priv(dev
->ieee80211_ptr
);
1487 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
1488 struct sta_info
*sta
;
1490 if (compare_ether_addr(remote_addr
, sdata
->u
.wds
.remote_addr
) == 0)
1493 /* Create STA entry for the new peer */
1494 sta
= sta_info_add(local
, dev
, remote_addr
, GFP_KERNEL
);
1499 /* Remove STA entry for the old peer */
1500 sta
= sta_info_get(local
, sdata
->u
.wds
.remote_addr
);
1503 sta_info_free(sta
, 0);
1505 printk(KERN_DEBUG
"%s: could not find STA entry for WDS link "
1506 "peer " MAC_FMT
"\n",
1507 dev
->name
, MAC_ARG(sdata
->u
.wds
.remote_addr
));
1510 /* Update WDS link data */
1511 memcpy(&sdata
->u
.wds
.remote_addr
, remote_addr
, ETH_ALEN
);
1516 /* Must not be called for mdev and apdev */
1517 void ieee80211_if_setup(struct net_device
*dev
)
1520 dev
->hard_start_xmit
= ieee80211_subif_start_xmit
;
1521 dev
->wireless_handlers
= &ieee80211_iw_handler_def
;
1522 dev
->set_multicast_list
= ieee80211_set_multicast_list
;
1523 dev
->change_mtu
= ieee80211_change_mtu
;
1524 dev
->get_stats
= ieee80211_get_stats
;
1525 dev
->open
= ieee80211_open
;
1526 dev
->stop
= ieee80211_stop
;
1527 dev
->uninit
= ieee80211_if_reinit
;
1528 dev
->destructor
= ieee80211_if_free
;
1531 void ieee80211_if_mgmt_setup(struct net_device
*dev
)
1534 dev
->hard_start_xmit
= ieee80211_mgmt_start_xmit
;
1535 dev
->change_mtu
= ieee80211_change_mtu_apdev
;
1536 dev
->get_stats
= ieee80211_get_stats
;
1537 dev
->open
= ieee80211_mgmt_open
;
1538 dev
->stop
= ieee80211_mgmt_stop
;
1539 dev
->type
= ARPHRD_IEEE80211_PRISM
;
1540 dev
->hard_header_parse
= header_parse_80211
;
1541 dev
->uninit
= ieee80211_if_reinit
;
1542 dev
->destructor
= ieee80211_if_free
;
1545 struct ieee80211_hw
*ieee80211_alloc_hw(size_t priv_data_len
,
1546 const struct ieee80211_ops
*ops
)
1548 struct net_device
*mdev
;
1549 struct ieee80211_local
*local
;
1550 struct ieee80211_sub_if_data
*sdata
;
1552 struct wiphy
*wiphy
;
1554 /* Ensure 32-byte alignment of our private data and hw private data.
1555 * We use the wiphy priv data for both our ieee80211_local and for
1556 * the driver's private data
1558 * In memory it'll be like this:
1560 * +-------------------------+
1562 * +-------------------------+
1563 * | struct ieee80211_local |
1564 * +-------------------------+
1565 * | driver's private data |
1566 * +-------------------------+
1569 priv_size
= ((sizeof(struct ieee80211_local
) +
1570 NETDEV_ALIGN_CONST
) & ~NETDEV_ALIGN_CONST
) +
1573 wiphy
= wiphy_new(&mac80211_config_ops
, priv_size
);
1578 wiphy
->privid
= mac80211_wiphy_privid
;
1580 local
= wiphy_priv(wiphy
);
1581 local
->hw
.wiphy
= wiphy
;
1583 local
->hw
.priv
= (char *)local
+
1584 ((sizeof(struct ieee80211_local
) +
1585 NETDEV_ALIGN_CONST
) & ~NETDEV_ALIGN_CONST
);
1588 BUG_ON(!ops
->config
);
1589 BUG_ON(!ops
->add_interface
);
1592 /* for now, mdev needs sub_if_data :/ */
1593 mdev
= alloc_netdev(sizeof(struct ieee80211_sub_if_data
),
1594 "wmaster%d", ether_setup
);
1600 sdata
= IEEE80211_DEV_TO_SUB_IF(mdev
);
1601 mdev
->ieee80211_ptr
= &sdata
->wdev
;
1602 sdata
->wdev
.wiphy
= wiphy
;
1604 local
->hw
.queues
= 1; /* default */
1607 local
->rx_pre_handlers
= ieee80211_rx_pre_handlers
;
1608 local
->rx_handlers
= ieee80211_rx_handlers
;
1609 local
->tx_handlers
= ieee80211_tx_handlers
;
1611 local
->bridge_packets
= 1;
1613 local
->rts_threshold
= IEEE80211_MAX_RTS_THRESHOLD
;
1614 local
->fragmentation_threshold
= IEEE80211_MAX_FRAG_THRESHOLD
;
1615 local
->short_retry_limit
= 7;
1616 local
->long_retry_limit
= 4;
1617 local
->hw
.conf
.radio_enabled
= 1;
1619 local
->enabled_modes
= (unsigned int) -1;
1621 INIT_LIST_HEAD(&local
->modes_list
);
1623 rwlock_init(&local
->sub_if_lock
);
1624 INIT_LIST_HEAD(&local
->sub_if_list
);
1626 INIT_DELAYED_WORK(&local
->scan_work
, ieee80211_sta_scan_work
);
1627 init_timer(&local
->stat_timer
);
1628 local
->stat_timer
.function
= ieee80211_stat_refresh
;
1629 local
->stat_timer
.data
= (unsigned long) local
;
1630 ieee80211_rx_bss_list_init(mdev
);
1632 sta_info_init(local
);
1634 mdev
->hard_start_xmit
= ieee80211_master_start_xmit
;
1635 mdev
->open
= ieee80211_master_open
;
1636 mdev
->stop
= ieee80211_master_stop
;
1637 mdev
->type
= ARPHRD_IEEE80211
;
1638 mdev
->hard_header_parse
= header_parse_80211
;
1640 sdata
->type
= IEEE80211_IF_TYPE_AP
;
1642 sdata
->local
= local
;
1643 sdata
->u
.ap
.force_unicast_rateidx
= -1;
1644 sdata
->u
.ap
.max_ratectrl_rateidx
= -1;
1645 ieee80211_if_sdata_init(sdata
);
1646 list_add_tail(&sdata
->list
, &local
->sub_if_list
);
1648 tasklet_init(&local
->tx_pending_tasklet
, ieee80211_tx_pending
,
1649 (unsigned long)local
);
1650 tasklet_disable(&local
->tx_pending_tasklet
);
1652 tasklet_init(&local
->tasklet
,
1653 ieee80211_tasklet_handler
,
1654 (unsigned long) local
);
1655 tasklet_disable(&local
->tasklet
);
1657 skb_queue_head_init(&local
->skb_queue
);
1658 skb_queue_head_init(&local
->skb_queue_unreliable
);
1660 return local_to_hw(local
);
1662 EXPORT_SYMBOL(ieee80211_alloc_hw
);
1664 int ieee80211_register_hw(struct ieee80211_hw
*hw
)
1666 struct ieee80211_local
*local
= hw_to_local(hw
);
1670 result
= wiphy_register(local
->hw
.wiphy
);
1674 name
= wiphy_dev(local
->hw
.wiphy
)->driver
->name
;
1675 local
->hw
.workqueue
= create_singlethread_workqueue(name
);
1676 if (!local
->hw
.workqueue
) {
1678 goto fail_workqueue
;
1682 * The hardware needs headroom for sending the frame,
1683 * and we need some headroom for passing the frame to monitor
1684 * interfaces, but never both at the same time.
1686 local
->tx_headroom
= max_t(unsigned int , local
->hw
.extra_tx_headroom
,
1687 sizeof(struct ieee80211_tx_status_rtap_hdr
));
1689 debugfs_hw_add(local
);
1691 local
->hw
.conf
.beacon_int
= 1000;
1693 local
->wstats_flags
|= local
->hw
.max_rssi
?
1694 IW_QUAL_LEVEL_UPDATED
: IW_QUAL_LEVEL_INVALID
;
1695 local
->wstats_flags
|= local
->hw
.max_signal
?
1696 IW_QUAL_QUAL_UPDATED
: IW_QUAL_QUAL_INVALID
;
1697 local
->wstats_flags
|= local
->hw
.max_noise
?
1698 IW_QUAL_NOISE_UPDATED
: IW_QUAL_NOISE_INVALID
;
1699 if (local
->hw
.max_rssi
< 0 || local
->hw
.max_noise
< 0)
1700 local
->wstats_flags
|= IW_QUAL_DBM
;
1702 result
= sta_info_start(local
);
1707 result
= dev_alloc_name(local
->mdev
, local
->mdev
->name
);
1711 memcpy(local
->mdev
->dev_addr
, local
->hw
.wiphy
->perm_addr
, ETH_ALEN
);
1712 SET_NETDEV_DEV(local
->mdev
, wiphy_dev(local
->hw
.wiphy
));
1714 result
= register_netdevice(local
->mdev
);
1718 ieee80211_debugfs_add_netdev(IEEE80211_DEV_TO_SUB_IF(local
->mdev
));
1720 result
= ieee80211_init_rate_ctrl_alg(local
, NULL
);
1722 printk(KERN_DEBUG
"%s: Failed to initialize rate control "
1723 "algorithm\n", local
->mdev
->name
);
1727 result
= ieee80211_wep_init(local
);
1730 printk(KERN_DEBUG
"%s: Failed to initialize wep\n",
1735 ieee80211_install_qdisc(local
->mdev
);
1737 /* add one default STA interface */
1738 result
= ieee80211_if_add(local
->mdev
, "wlan%d", NULL
,
1739 IEEE80211_IF_TYPE_STA
);
1741 printk(KERN_WARNING
"%s: Failed to add default virtual iface\n",
1744 local
->reg_state
= IEEE80211_DEV_REGISTERED
;
1747 ieee80211_led_init(local
);
1752 rate_control_deinitialize(local
);
1754 ieee80211_debugfs_remove_netdev(IEEE80211_DEV_TO_SUB_IF(local
->mdev
));
1755 unregister_netdevice(local
->mdev
);
1758 sta_info_stop(local
);
1760 debugfs_hw_del(local
);
1761 destroy_workqueue(local
->hw
.workqueue
);
1763 wiphy_unregister(local
->hw
.wiphy
);
1766 EXPORT_SYMBOL(ieee80211_register_hw
);
1768 int ieee80211_register_hwmode(struct ieee80211_hw
*hw
,
1769 struct ieee80211_hw_mode
*mode
)
1771 struct ieee80211_local
*local
= hw_to_local(hw
);
1772 struct ieee80211_rate
*rate
;
1775 INIT_LIST_HEAD(&mode
->list
);
1776 list_add_tail(&mode
->list
, &local
->modes_list
);
1778 local
->hw_modes
|= (1 << mode
->mode
);
1779 for (i
= 0; i
< mode
->num_rates
; i
++) {
1780 rate
= &(mode
->rates
[i
]);
1781 rate
->rate_inv
= CHAN_UTIL_RATE_LCM
/ rate
->rate
;
1783 ieee80211_prepare_rates(local
, mode
);
1785 if (!local
->oper_hw_mode
) {
1786 /* Default to this mode */
1787 local
->hw
.conf
.phymode
= mode
->mode
;
1788 local
->oper_hw_mode
= local
->scan_hw_mode
= mode
;
1789 local
->oper_channel
= local
->scan_channel
= &mode
->channels
[0];
1790 local
->hw
.conf
.mode
= local
->oper_hw_mode
;
1791 local
->hw
.conf
.chan
= local
->oper_channel
;
1794 if (!(hw
->flags
& IEEE80211_HW_DEFAULT_REG_DOMAIN_CONFIGURED
))
1795 ieee80211_set_default_regdomain(mode
);
1799 EXPORT_SYMBOL(ieee80211_register_hwmode
);
1801 void ieee80211_unregister_hw(struct ieee80211_hw
*hw
)
1803 struct ieee80211_local
*local
= hw_to_local(hw
);
1804 struct ieee80211_sub_if_data
*sdata
, *tmp
;
1805 struct list_head tmp_list
;
1808 tasklet_kill(&local
->tx_pending_tasklet
);
1809 tasklet_kill(&local
->tasklet
);
1813 BUG_ON(local
->reg_state
!= IEEE80211_DEV_REGISTERED
);
1815 local
->reg_state
= IEEE80211_DEV_UNREGISTERED
;
1817 ieee80211_if_del_mgmt(local
);
1819 write_lock_bh(&local
->sub_if_lock
);
1820 list_replace_init(&local
->sub_if_list
, &tmp_list
);
1821 write_unlock_bh(&local
->sub_if_lock
);
1823 list_for_each_entry_safe(sdata
, tmp
, &tmp_list
, list
)
1824 __ieee80211_if_del(local
, sdata
);
1828 if (local
->stat_time
)
1829 del_timer_sync(&local
->stat_timer
);
1831 ieee80211_rx_bss_list_deinit(local
->mdev
);
1832 ieee80211_clear_tx_pending(local
);
1833 sta_info_stop(local
);
1834 rate_control_deinitialize(local
);
1835 debugfs_hw_del(local
);
1837 for (i
= 0; i
< NUM_IEEE80211_MODES
; i
++) {
1838 kfree(local
->supp_rates
[i
]);
1839 kfree(local
->basic_rates
[i
]);
1842 if (skb_queue_len(&local
->skb_queue
)
1843 || skb_queue_len(&local
->skb_queue_unreliable
))
1844 printk(KERN_WARNING
"%s: skb_queue not empty\n",
1846 skb_queue_purge(&local
->skb_queue
);
1847 skb_queue_purge(&local
->skb_queue_unreliable
);
1849 destroy_workqueue(local
->hw
.workqueue
);
1850 wiphy_unregister(local
->hw
.wiphy
);
1851 ieee80211_wep_free(local
);
1852 ieee80211_led_exit(local
);
1854 EXPORT_SYMBOL(ieee80211_unregister_hw
);
1856 void ieee80211_free_hw(struct ieee80211_hw
*hw
)
1858 struct ieee80211_local
*local
= hw_to_local(hw
);
1860 ieee80211_if_free(local
->mdev
);
1861 wiphy_free(local
->hw
.wiphy
);
1863 EXPORT_SYMBOL(ieee80211_free_hw
);
1865 void ieee80211_wake_queue(struct ieee80211_hw
*hw
, int queue
)
1867 struct ieee80211_local
*local
= hw_to_local(hw
);
1869 if (test_and_clear_bit(IEEE80211_LINK_STATE_XOFF
,
1870 &local
->state
[queue
])) {
1871 if (test_bit(IEEE80211_LINK_STATE_PENDING
,
1872 &local
->state
[queue
]))
1873 tasklet_schedule(&local
->tx_pending_tasklet
);
1875 if (!ieee80211_qdisc_installed(local
->mdev
)) {
1877 netif_wake_queue(local
->mdev
);
1879 __netif_schedule(local
->mdev
);
1882 EXPORT_SYMBOL(ieee80211_wake_queue
);
1884 void ieee80211_stop_queue(struct ieee80211_hw
*hw
, int queue
)
1886 struct ieee80211_local
*local
= hw_to_local(hw
);
1888 if (!ieee80211_qdisc_installed(local
->mdev
) && queue
== 0)
1889 netif_stop_queue(local
->mdev
);
1890 set_bit(IEEE80211_LINK_STATE_XOFF
, &local
->state
[queue
]);
1892 EXPORT_SYMBOL(ieee80211_stop_queue
);
1894 void ieee80211_start_queues(struct ieee80211_hw
*hw
)
1896 struct ieee80211_local
*local
= hw_to_local(hw
);
1899 for (i
= 0; i
< local
->hw
.queues
; i
++)
1900 clear_bit(IEEE80211_LINK_STATE_XOFF
, &local
->state
[i
]);
1901 if (!ieee80211_qdisc_installed(local
->mdev
))
1902 netif_start_queue(local
->mdev
);
1904 EXPORT_SYMBOL(ieee80211_start_queues
);
1906 void ieee80211_stop_queues(struct ieee80211_hw
*hw
)
1910 for (i
= 0; i
< hw
->queues
; i
++)
1911 ieee80211_stop_queue(hw
, i
);
1913 EXPORT_SYMBOL(ieee80211_stop_queues
);
1915 void ieee80211_wake_queues(struct ieee80211_hw
*hw
)
1919 for (i
= 0; i
< hw
->queues
; i
++)
1920 ieee80211_wake_queue(hw
, i
);
1922 EXPORT_SYMBOL(ieee80211_wake_queues
);
1924 struct net_device_stats
*ieee80211_dev_stats(struct net_device
*dev
)
1926 struct ieee80211_sub_if_data
*sdata
;
1927 sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
1928 return &sdata
->stats
;
1931 static int __init
ieee80211_init(void)
1933 struct sk_buff
*skb
;
1936 BUILD_BUG_ON(sizeof(struct ieee80211_tx_packet_data
) > sizeof(skb
->cb
));
1938 ret
= ieee80211_wme_register();
1940 printk(KERN_DEBUG
"ieee80211_init: failed to "
1941 "initialize WME (err=%d)\n", ret
);
1945 ieee80211_debugfs_netdev_init();
1946 ieee80211_regdomain_init();
1952 static void __exit
ieee80211_exit(void)
1954 ieee80211_wme_unregister();
1955 ieee80211_debugfs_netdev_exit();
1959 subsys_initcall(ieee80211_init
);
1960 module_exit(ieee80211_exit
);
1962 MODULE_DESCRIPTION("IEEE 802.11 subsystem");
1963 MODULE_LICENSE("GPL");