2 * Host AP (software wireless LAN access point) driver for
3 * Intersil Prism2/2.5/3 - hostap.o module, common routines
5 * Copyright (c) 2001-2002, SSH Communications Security Corp and Jouni Malinen
7 * Copyright (c) 2002-2005, Jouni Malinen <j@w1.fi>
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation. See README and COPYING for
15 #include <linux/module.h>
16 #include <linux/init.h>
17 #include <linux/slab.h>
18 #include <linux/proc_fs.h>
19 #include <linux/if_arp.h>
20 #include <linux/delay.h>
21 #include <linux/random.h>
22 #include <linux/workqueue.h>
23 #include <linux/kmod.h>
24 #include <linux/rtnetlink.h>
25 #include <linux/wireless.h>
26 #include <linux/etherdevice.h>
27 #include <net/net_namespace.h>
28 #include <net/iw_handler.h>
29 #include <net/ieee80211.h>
30 #include <net/ieee80211_crypt.h>
31 #include <asm/uaccess.h>
33 #include "hostap_wlan.h"
34 #include "hostap_80211.h"
35 #include "hostap_ap.h"
38 MODULE_AUTHOR("Jouni Malinen");
39 MODULE_DESCRIPTION("Host AP common routines");
40 MODULE_LICENSE("GPL");
42 #define TX_TIMEOUT (2 * HZ)
44 #define PRISM2_MAX_FRAME_SIZE 2304
45 #define PRISM2_MIN_MTU 256
47 #define PRISM2_MAX_MTU (PRISM2_MAX_FRAME_SIZE - (6 /* LLC */ + 8 /* WEP */))
50 struct net_device
* hostap_add_interface(struct local_info
*local
,
51 int type
, int rtnl_locked
,
55 struct net_device
*dev
, *mdev
;
56 struct hostap_interface
*iface
;
59 dev
= alloc_etherdev(sizeof(struct hostap_interface
));
63 iface
= netdev_priv(dev
);
67 list_add(&iface
->list
, &local
->hostap_interfaces
);
70 memcpy(dev
->dev_addr
, mdev
->dev_addr
, ETH_ALEN
);
71 dev
->base_addr
= mdev
->base_addr
;
73 dev
->mem_start
= mdev
->mem_start
;
74 dev
->mem_end
= mdev
->mem_end
;
76 hostap_setup_dev(dev
, local
, type
);
77 dev
->destructor
= free_netdev
;
79 sprintf(dev
->name
, "%s%s", prefix
, name
);
84 if (strchr(dev
->name
, '%'))
85 ret
= dev_alloc_name(dev
, dev
->name
);
87 SET_NETDEV_DEV(dev
, mdev
->dev
.parent
);
89 ret
= register_netdevice(dev
);
95 printk(KERN_WARNING
"%s: failed to add new netdevice!\n",
101 printk(KERN_DEBUG
"%s: registered netdevice %s\n",
102 mdev
->name
, dev
->name
);
108 void hostap_remove_interface(struct net_device
*dev
, int rtnl_locked
,
109 int remove_from_list
)
111 struct hostap_interface
*iface
;
116 iface
= netdev_priv(dev
);
118 if (remove_from_list
) {
119 list_del(&iface
->list
);
122 if (dev
== iface
->local
->ddev
)
123 iface
->local
->ddev
= NULL
;
124 else if (dev
== iface
->local
->apdev
)
125 iface
->local
->apdev
= NULL
;
126 else if (dev
== iface
->local
->stadev
)
127 iface
->local
->stadev
= NULL
;
130 unregister_netdevice(dev
);
132 unregister_netdev(dev
);
134 /* dev->destructor = free_netdev() will free the device data, including
135 * private data, when removing the device */
139 static inline int prism2_wds_special_addr(u8
*addr
)
141 if (addr
[0] || addr
[1] || addr
[2] || addr
[3] || addr
[4] || addr
[5])
148 int prism2_wds_add(local_info_t
*local
, u8
*remote_addr
,
151 struct net_device
*dev
;
152 struct list_head
*ptr
;
153 struct hostap_interface
*iface
, *empty
, *match
;
155 empty
= match
= NULL
;
156 read_lock_bh(&local
->iface_lock
);
157 list_for_each(ptr
, &local
->hostap_interfaces
) {
158 iface
= list_entry(ptr
, struct hostap_interface
, list
);
159 if (iface
->type
!= HOSTAP_INTERFACE_WDS
)
162 if (prism2_wds_special_addr(iface
->u
.wds
.remote_addr
))
164 else if (memcmp(iface
->u
.wds
.remote_addr
, remote_addr
,
170 if (!match
&& empty
&& !prism2_wds_special_addr(remote_addr
)) {
171 /* take pre-allocated entry into use */
172 memcpy(empty
->u
.wds
.remote_addr
, remote_addr
, ETH_ALEN
);
173 read_unlock_bh(&local
->iface_lock
);
174 printk(KERN_DEBUG
"%s: using pre-allocated WDS netdevice %s\n",
175 local
->dev
->name
, empty
->dev
->name
);
178 read_unlock_bh(&local
->iface_lock
);
180 if (!prism2_wds_special_addr(remote_addr
)) {
183 hostap_add_sta(local
->ap
, remote_addr
);
186 if (local
->wds_connections
>= local
->wds_max_connections
)
189 /* verify that there is room for wds# postfix in the interface name */
190 if (strlen(local
->dev
->name
) > IFNAMSIZ
- 5) {
191 printk(KERN_DEBUG
"'%s' too long base device name\n",
196 dev
= hostap_add_interface(local
, HOSTAP_INTERFACE_WDS
, rtnl_locked
,
197 local
->ddev
->name
, "wds%d");
201 iface
= netdev_priv(dev
);
202 memcpy(iface
->u
.wds
.remote_addr
, remote_addr
, ETH_ALEN
);
204 local
->wds_connections
++;
210 int prism2_wds_del(local_info_t
*local
, u8
*remote_addr
,
211 int rtnl_locked
, int do_not_remove
)
214 struct list_head
*ptr
;
215 struct hostap_interface
*iface
, *selected
= NULL
;
217 write_lock_irqsave(&local
->iface_lock
, flags
);
218 list_for_each(ptr
, &local
->hostap_interfaces
) {
219 iface
= list_entry(ptr
, struct hostap_interface
, list
);
220 if (iface
->type
!= HOSTAP_INTERFACE_WDS
)
223 if (memcmp(iface
->u
.wds
.remote_addr
, remote_addr
,
229 if (selected
&& !do_not_remove
)
230 list_del(&selected
->list
);
231 write_unlock_irqrestore(&local
->iface_lock
, flags
);
235 memset(selected
->u
.wds
.remote_addr
, 0, ETH_ALEN
);
237 hostap_remove_interface(selected
->dev
, rtnl_locked
, 0);
238 local
->wds_connections
--;
242 return selected
? 0 : -ENODEV
;
246 u16
hostap_tx_callback_register(local_info_t
*local
,
247 void (*func
)(struct sk_buff
*, int ok
, void *),
251 struct hostap_tx_callback_info
*entry
;
253 entry
= kmalloc(sizeof(*entry
),
261 spin_lock_irqsave(&local
->lock
, flags
);
262 entry
->idx
= local
->tx_callback
? local
->tx_callback
->idx
+ 1 : 1;
263 entry
->next
= local
->tx_callback
;
264 local
->tx_callback
= entry
;
265 spin_unlock_irqrestore(&local
->lock
, flags
);
271 int hostap_tx_callback_unregister(local_info_t
*local
, u16 idx
)
274 struct hostap_tx_callback_info
*cb
, *prev
= NULL
;
276 spin_lock_irqsave(&local
->lock
, flags
);
277 cb
= local
->tx_callback
;
278 while (cb
!= NULL
&& cb
->idx
!= idx
) {
284 local
->tx_callback
= cb
->next
;
286 prev
->next
= cb
->next
;
289 spin_unlock_irqrestore(&local
->lock
, flags
);
295 /* val is in host byte order */
296 int hostap_set_word(struct net_device
*dev
, int rid
, u16 val
)
298 struct hostap_interface
*iface
;
299 __le16 tmp
= cpu_to_le16(val
);
300 iface
= netdev_priv(dev
);
301 return iface
->local
->func
->set_rid(dev
, rid
, &tmp
, 2);
305 int hostap_set_string(struct net_device
*dev
, int rid
, const char *val
)
307 struct hostap_interface
*iface
;
308 char buf
[MAX_SSID_LEN
+ 2];
311 iface
= netdev_priv(dev
);
313 if (len
> MAX_SSID_LEN
)
315 memset(buf
, 0, sizeof(buf
));
316 buf
[0] = len
; /* little endian 16 bit word */
317 memcpy(buf
+ 2, val
, len
);
319 return iface
->local
->func
->set_rid(dev
, rid
, &buf
, MAX_SSID_LEN
+ 2);
323 u16
hostap_get_porttype(local_info_t
*local
)
325 if (local
->iw_mode
== IW_MODE_ADHOC
&& local
->pseudo_adhoc
)
326 return HFA384X_PORTTYPE_PSEUDO_IBSS
;
327 if (local
->iw_mode
== IW_MODE_ADHOC
)
328 return HFA384X_PORTTYPE_IBSS
;
329 if (local
->iw_mode
== IW_MODE_INFRA
)
330 return HFA384X_PORTTYPE_BSS
;
331 if (local
->iw_mode
== IW_MODE_REPEAT
)
332 return HFA384X_PORTTYPE_WDS
;
333 if (local
->iw_mode
== IW_MODE_MONITOR
)
334 return HFA384X_PORTTYPE_PSEUDO_IBSS
;
335 return HFA384X_PORTTYPE_HOSTAP
;
339 int hostap_set_encryption(local_info_t
*local
)
342 int i
, keylen
, len
, idx
;
343 char keybuf
[WEP_KEY_LEN
+ 1];
344 enum { NONE
, WEP
, OTHER
} encrypt_type
;
346 idx
= local
->tx_keyidx
;
347 if (local
->crypt
[idx
] == NULL
|| local
->crypt
[idx
]->ops
== NULL
)
349 else if (strcmp(local
->crypt
[idx
]->ops
->name
, "WEP") == 0)
352 encrypt_type
= OTHER
;
354 if (local
->func
->get_rid(local
->dev
, HFA384X_RID_CNFWEPFLAGS
, &val
, 2,
356 printk(KERN_DEBUG
"Could not read current WEP flags.\n");
362 if (encrypt_type
!= NONE
|| local
->privacy_invoked
)
363 val
|= HFA384X_WEPFLAGS_PRIVACYINVOKED
;
365 val
&= ~HFA384X_WEPFLAGS_PRIVACYINVOKED
;
367 if (local
->open_wep
|| encrypt_type
== NONE
||
368 ((local
->ieee_802_1x
|| local
->wpa
) && local
->host_decrypt
))
369 val
&= ~HFA384X_WEPFLAGS_EXCLUDEUNENCRYPTED
;
371 val
|= HFA384X_WEPFLAGS_EXCLUDEUNENCRYPTED
;
373 if ((encrypt_type
!= NONE
|| local
->privacy_invoked
) &&
374 (encrypt_type
== OTHER
|| local
->host_encrypt
))
375 val
|= HFA384X_WEPFLAGS_HOSTENCRYPT
;
377 val
&= ~HFA384X_WEPFLAGS_HOSTENCRYPT
;
378 if ((encrypt_type
!= NONE
|| local
->privacy_invoked
) &&
379 (encrypt_type
== OTHER
|| local
->host_decrypt
))
380 val
|= HFA384X_WEPFLAGS_HOSTDECRYPT
;
382 val
&= ~HFA384X_WEPFLAGS_HOSTDECRYPT
;
384 if (val
!= old_val
&&
385 hostap_set_word(local
->dev
, HFA384X_RID_CNFWEPFLAGS
, val
)) {
386 printk(KERN_DEBUG
"Could not write new WEP flags (0x%x)\n",
391 if (encrypt_type
!= WEP
)
394 /* 104-bit support seems to require that all the keys are set to the
396 keylen
= 6; /* first 5 octets */
397 len
= local
->crypt
[idx
]->ops
->get_key(keybuf
, sizeof(keybuf
),
398 NULL
, local
->crypt
[idx
]->priv
);
399 if (idx
>= 0 && idx
< WEP_KEYS
&& len
> 5)
400 keylen
= WEP_KEY_LEN
+ 1; /* first 13 octets */
402 for (i
= 0; i
< WEP_KEYS
; i
++) {
403 memset(keybuf
, 0, sizeof(keybuf
));
404 if (local
->crypt
[i
]) {
405 (void) local
->crypt
[i
]->ops
->get_key(
406 keybuf
, sizeof(keybuf
),
407 NULL
, local
->crypt
[i
]->priv
);
409 if (local
->func
->set_rid(local
->dev
,
410 HFA384X_RID_CNFDEFAULTKEY0
+ i
,
412 printk(KERN_DEBUG
"Could not set key %d (len=%d)\n",
417 if (hostap_set_word(local
->dev
, HFA384X_RID_CNFWEPDEFAULTKEYID
, idx
)) {
418 printk(KERN_DEBUG
"Could not set default keyid %d\n", idx
);
425 printk(KERN_DEBUG
"%s: encryption setup failed\n", local
->dev
->name
);
430 int hostap_set_antsel(local_info_t
*local
)
435 if (local
->antsel_tx
!= HOSTAP_ANTSEL_DO_NOT_TOUCH
&&
436 local
->func
->cmd(local
->dev
, HFA384X_CMDCODE_READMIF
,
437 HFA386X_CR_TX_CONFIGURE
,
439 val
&= ~(BIT(2) | BIT(1));
440 switch (local
->antsel_tx
) {
441 case HOSTAP_ANTSEL_DIVERSITY
:
444 case HOSTAP_ANTSEL_LOW
:
446 case HOSTAP_ANTSEL_HIGH
:
451 if (local
->func
->cmd(local
->dev
, HFA384X_CMDCODE_WRITEMIF
,
452 HFA386X_CR_TX_CONFIGURE
, &val
, NULL
)) {
453 printk(KERN_INFO
"%s: setting TX AntSel failed\n",
459 if (local
->antsel_rx
!= HOSTAP_ANTSEL_DO_NOT_TOUCH
&&
460 local
->func
->cmd(local
->dev
, HFA384X_CMDCODE_READMIF
,
461 HFA386X_CR_RX_CONFIGURE
,
463 val
&= ~(BIT(1) | BIT(0));
464 switch (local
->antsel_rx
) {
465 case HOSTAP_ANTSEL_DIVERSITY
:
467 case HOSTAP_ANTSEL_LOW
:
470 case HOSTAP_ANTSEL_HIGH
:
471 val
|= BIT(0) | BIT(1);
475 if (local
->func
->cmd(local
->dev
, HFA384X_CMDCODE_WRITEMIF
,
476 HFA386X_CR_RX_CONFIGURE
, &val
, NULL
)) {
477 printk(KERN_INFO
"%s: setting RX AntSel failed\n",
487 int hostap_set_roaming(local_info_t
*local
)
491 switch (local
->host_roaming
) {
493 val
= HFA384X_ROAMING_HOST
;
496 val
= HFA384X_ROAMING_DISABLED
;
500 val
= HFA384X_ROAMING_FIRMWARE
;
504 return hostap_set_word(local
->dev
, HFA384X_RID_CNFROAMINGMODE
, val
);
508 int hostap_set_auth_algs(local_info_t
*local
)
510 int val
= local
->auth_algs
;
511 /* At least STA f/w v0.6.2 seems to have issues with cnfAuthentication
512 * set to include both Open and Shared Key flags. It tries to use
513 * Shared Key authentication in that case even if WEP keys are not
514 * configured.. STA f/w v0.7.6 is able to handle such configuration,
515 * but it is unknown when this was fixed between 0.6.2 .. 0.7.6. */
516 if (local
->sta_fw_ver
< PRISM2_FW_VER(0,7,0) &&
517 val
!= PRISM2_AUTH_OPEN
&& val
!= PRISM2_AUTH_SHARED_KEY
)
518 val
= PRISM2_AUTH_OPEN
;
520 if (hostap_set_word(local
->dev
, HFA384X_RID_CNFAUTHENTICATION
, val
)) {
521 printk(KERN_INFO
"%s: cnfAuthentication setting to 0x%x "
522 "failed\n", local
->dev
->name
, local
->auth_algs
);
530 void hostap_dump_rx_header(const char *name
, const struct hfa384x_rx_frame
*rx
)
533 DECLARE_MAC_BUF(mac
);
534 DECLARE_MAC_BUF(mac2
);
535 DECLARE_MAC_BUF(mac3
);
536 DECLARE_MAC_BUF(mac4
);
538 status
= __le16_to_cpu(rx
->status
);
540 printk(KERN_DEBUG
"%s: RX status=0x%04x (port=%d, type=%d, "
541 "fcserr=%d) silence=%d signal=%d rate=%d rxflow=%d; "
543 name
, status
, (status
>> 8) & 0x07, status
>> 13, status
& 1,
544 rx
->silence
, rx
->signal
, rx
->rate
, rx
->rxflow
, jiffies
);
546 fc
= __le16_to_cpu(rx
->frame_control
);
547 printk(KERN_DEBUG
" FC=0x%04x (type=%d:%d) dur=0x%04x seq=0x%04x "
549 fc
, WLAN_FC_GET_TYPE(fc
) >> 2, WLAN_FC_GET_STYPE(fc
) >> 4,
550 __le16_to_cpu(rx
->duration_id
), __le16_to_cpu(rx
->seq_ctrl
),
551 __le16_to_cpu(rx
->data_len
),
552 fc
& IEEE80211_FCTL_TODS
? " [ToDS]" : "",
553 fc
& IEEE80211_FCTL_FROMDS
? " [FromDS]" : "");
555 printk(KERN_DEBUG
" A1=%s A2=%s A3=%s A4=%s\n",
556 print_mac(mac
, rx
->addr1
), print_mac(mac2
, rx
->addr2
),
557 print_mac(mac3
, rx
->addr3
), print_mac(mac4
, rx
->addr4
));
559 printk(KERN_DEBUG
" dst=%s src=%s len=%d\n",
560 print_mac(mac
, rx
->dst_addr
), print_mac(mac2
, rx
->src_addr
),
561 __be16_to_cpu(rx
->len
));
565 void hostap_dump_tx_header(const char *name
, const struct hfa384x_tx_frame
*tx
)
568 DECLARE_MAC_BUF(mac
);
569 DECLARE_MAC_BUF(mac2
);
570 DECLARE_MAC_BUF(mac3
);
571 DECLARE_MAC_BUF(mac4
);
573 printk(KERN_DEBUG
"%s: TX status=0x%04x retry_count=%d tx_rate=%d "
574 "tx_control=0x%04x; jiffies=%ld\n",
575 name
, __le16_to_cpu(tx
->status
), tx
->retry_count
, tx
->tx_rate
,
576 __le16_to_cpu(tx
->tx_control
), jiffies
);
578 fc
= __le16_to_cpu(tx
->frame_control
);
579 printk(KERN_DEBUG
" FC=0x%04x (type=%d:%d) dur=0x%04x seq=0x%04x "
581 fc
, WLAN_FC_GET_TYPE(fc
) >> 2, WLAN_FC_GET_STYPE(fc
) >> 4,
582 __le16_to_cpu(tx
->duration_id
), __le16_to_cpu(tx
->seq_ctrl
),
583 __le16_to_cpu(tx
->data_len
),
584 fc
& IEEE80211_FCTL_TODS
? " [ToDS]" : "",
585 fc
& IEEE80211_FCTL_FROMDS
? " [FromDS]" : "");
587 printk(KERN_DEBUG
" A1=%s A2=%s A3=%s A4=%s\n",
588 print_mac(mac
, tx
->addr1
), print_mac(mac2
, tx
->addr2
),
589 print_mac(mac3
, tx
->addr3
), print_mac(mac4
, tx
->addr4
));
591 printk(KERN_DEBUG
" dst=%s src=%s len=%d\n",
592 print_mac(mac
, tx
->dst_addr
), print_mac(mac2
, tx
->src_addr
),
593 __be16_to_cpu(tx
->len
));
597 int hostap_80211_header_parse(const struct sk_buff
*skb
, unsigned char *haddr
)
599 struct hostap_interface
*iface
= netdev_priv(skb
->dev
);
600 local_info_t
*local
= iface
->local
;
602 if (local
->monitor_type
== PRISM2_MONITOR_PRISM
||
603 local
->monitor_type
== PRISM2_MONITOR_CAPHDR
) {
604 const unsigned char *mac
= skb_mac_header(skb
);
606 if (*(u32
*)mac
== LWNG_CAP_DID_BASE
) {
608 mac
+ sizeof(struct linux_wlan_ng_prism_hdr
) + 10,
609 ETH_ALEN
); /* addr2 */
610 } else { /* (*(u32 *)mac == htonl(LWNG_CAPHDR_VERSION)) */
612 mac
+ sizeof(struct linux_wlan_ng_cap_hdr
) + 10,
613 ETH_ALEN
); /* addr2 */
616 memcpy(haddr
, skb_mac_header(skb
) + 10, ETH_ALEN
); /* addr2 */
622 int hostap_80211_get_hdrlen(u16 fc
)
626 switch (WLAN_FC_GET_TYPE(fc
)) {
627 case IEEE80211_FTYPE_DATA
:
628 if ((fc
& IEEE80211_FCTL_FROMDS
) && (fc
& IEEE80211_FCTL_TODS
))
629 hdrlen
= 30; /* Addr4 */
631 case IEEE80211_FTYPE_CTL
:
632 switch (WLAN_FC_GET_STYPE(fc
)) {
633 case IEEE80211_STYPE_CTS
:
634 case IEEE80211_STYPE_ACK
:
648 struct net_device_stats
*hostap_get_stats(struct net_device
*dev
)
650 struct hostap_interface
*iface
;
651 iface
= netdev_priv(dev
);
652 return &iface
->stats
;
656 static int prism2_close(struct net_device
*dev
)
658 struct hostap_interface
*iface
;
661 PDEBUG(DEBUG_FLOW
, "%s: prism2_close\n", dev
->name
);
663 iface
= netdev_priv(dev
);
664 local
= iface
->local
;
666 if (dev
== local
->ddev
) {
667 prism2_sta_deauth(local
, WLAN_REASON_DEAUTH_LEAVING
);
669 #ifndef PRISM2_NO_KERNEL_IEEE80211_MGMT
670 if (!local
->hostapd
&& dev
== local
->dev
&&
671 (!local
->func
->card_present
|| local
->func
->card_present(local
)) &&
672 local
->hw_ready
&& local
->ap
&& local
->iw_mode
== IW_MODE_MASTER
)
673 hostap_deauth_all_stas(dev
, local
->ap
, 1);
674 #endif /* PRISM2_NO_KERNEL_IEEE80211_MGMT */
676 if (dev
== local
->dev
) {
677 local
->func
->hw_shutdown(dev
, HOSTAP_HW_ENABLE_CMDCOMPL
);
680 if (netif_running(dev
)) {
681 netif_stop_queue(dev
);
682 netif_device_detach(dev
);
685 flush_scheduled_work();
687 module_put(local
->hw_module
);
689 local
->num_dev_open
--;
691 if (dev
!= local
->dev
&& local
->dev
->flags
& IFF_UP
&&
692 local
->master_dev_auto_open
&& local
->num_dev_open
== 1) {
693 /* Close master radio interface automatically if it was also
694 * opened automatically and we are now closing the last
695 * remaining non-master device. */
696 dev_close(local
->dev
);
703 static int prism2_open(struct net_device
*dev
)
705 struct hostap_interface
*iface
;
708 PDEBUG(DEBUG_FLOW
, "%s: prism2_open\n", dev
->name
);
710 iface
= netdev_priv(dev
);
711 local
= iface
->local
;
714 printk(KERN_DEBUG
"%s: could not set interface UP - no PRI "
719 if ((local
->func
->card_present
&& !local
->func
->card_present(local
)) ||
720 local
->hw_downloading
)
723 if (!try_module_get(local
->hw_module
))
725 local
->num_dev_open
++;
727 if (!local
->dev_enabled
&& local
->func
->hw_enable(dev
, 1)) {
728 printk(KERN_WARNING
"%s: could not enable MAC port\n",
733 if (!local
->dev_enabled
)
734 prism2_callback(local
, PRISM2_CALLBACK_ENABLE
);
735 local
->dev_enabled
= 1;
737 if (dev
!= local
->dev
&& !(local
->dev
->flags
& IFF_UP
)) {
738 /* Master radio interface is needed for all operation, so open
739 * it automatically when any virtual net_device is opened. */
740 local
->master_dev_auto_open
= 1;
741 dev_open(local
->dev
);
744 netif_device_attach(dev
);
745 netif_start_queue(dev
);
751 static int prism2_set_mac_address(struct net_device
*dev
, void *p
)
753 struct hostap_interface
*iface
;
755 struct list_head
*ptr
;
756 struct sockaddr
*addr
= p
;
758 iface
= netdev_priv(dev
);
759 local
= iface
->local
;
761 if (local
->func
->set_rid(dev
, HFA384X_RID_CNFOWNMACADDR
, addr
->sa_data
,
762 ETH_ALEN
) < 0 || local
->func
->reset_port(dev
))
765 read_lock_bh(&local
->iface_lock
);
766 list_for_each(ptr
, &local
->hostap_interfaces
) {
767 iface
= list_entry(ptr
, struct hostap_interface
, list
);
768 memcpy(iface
->dev
->dev_addr
, addr
->sa_data
, ETH_ALEN
);
770 memcpy(local
->dev
->dev_addr
, addr
->sa_data
, ETH_ALEN
);
771 read_unlock_bh(&local
->iface_lock
);
777 /* TODO: to be further implemented as soon as Prism2 fully supports
778 * GroupAddresses and correct documentation is available */
779 void hostap_set_multicast_list_queue(struct work_struct
*work
)
781 local_info_t
*local
=
782 container_of(work
, local_info_t
, set_multicast_list_queue
);
783 struct net_device
*dev
= local
->dev
;
784 struct hostap_interface
*iface
;
786 iface
= netdev_priv(dev
);
787 if (hostap_set_word(dev
, HFA384X_RID_PROMISCUOUSMODE
,
788 local
->is_promisc
)) {
789 printk(KERN_INFO
"%s: %sabling promiscuous mode failed\n",
790 dev
->name
, local
->is_promisc
? "en" : "dis");
795 static void hostap_set_multicast_list(struct net_device
*dev
)
798 /* FIX: promiscuous mode seems to be causing a lot of problems with
799 * some station firmware versions (FCSErr frames, invalid MACPort, etc.
800 * corrupted incoming frames). This code is now commented out while the
801 * problems are investigated. */
802 struct hostap_interface
*iface
;
805 iface
= netdev_priv(dev
);
806 local
= iface
->local
;
807 if ((dev
->flags
& IFF_ALLMULTI
) || (dev
->flags
& IFF_PROMISC
)) {
808 local
->is_promisc
= 1;
810 local
->is_promisc
= 0;
813 schedule_work(&local
->set_multicast_list_queue
);
818 static int prism2_change_mtu(struct net_device
*dev
, int new_mtu
)
820 if (new_mtu
< PRISM2_MIN_MTU
|| new_mtu
> PRISM2_MAX_MTU
)
828 static void prism2_tx_timeout(struct net_device
*dev
)
830 struct hostap_interface
*iface
;
832 struct hfa384x_regs regs
;
834 iface
= netdev_priv(dev
);
835 local
= iface
->local
;
837 printk(KERN_WARNING
"%s Tx timed out! Resetting card\n", dev
->name
);
838 netif_stop_queue(local
->dev
);
840 local
->func
->read_regs(dev
, ®s
);
841 printk(KERN_DEBUG
"%s: CMD=%04x EVSTAT=%04x "
842 "OFFSET0=%04x OFFSET1=%04x SWSUPPORT0=%04x\n",
843 dev
->name
, regs
.cmd
, regs
.evstat
, regs
.offset0
, regs
.offset1
,
846 local
->func
->schedule_reset(local
);
849 const struct header_ops hostap_80211_ops
= {
850 .create
= eth_header
,
851 .rebuild
= eth_rebuild_header
,
852 .cache
= eth_header_cache
,
853 .cache_update
= eth_header_cache_update
,
855 .parse
= hostap_80211_header_parse
,
857 EXPORT_SYMBOL(hostap_80211_ops
);
859 void hostap_setup_dev(struct net_device
*dev
, local_info_t
*local
,
862 struct hostap_interface
*iface
;
864 iface
= netdev_priv(dev
);
867 /* kernel callbacks */
868 dev
->get_stats
= hostap_get_stats
;
870 /* Currently, we point to the proper spy_data only on
871 * the main_dev. This could be fixed. Jean II */
872 iface
->wireless_data
.spy_data
= &iface
->spy_data
;
873 dev
->wireless_data
= &iface
->wireless_data
;
875 dev
->wireless_handlers
=
876 (struct iw_handler_def
*) &hostap_iw_handler_def
;
877 dev
->do_ioctl
= hostap_ioctl
;
878 dev
->open
= prism2_open
;
879 dev
->stop
= prism2_close
;
880 dev
->set_mac_address
= prism2_set_mac_address
;
881 dev
->set_multicast_list
= hostap_set_multicast_list
;
882 dev
->change_mtu
= prism2_change_mtu
;
883 dev
->tx_timeout
= prism2_tx_timeout
;
884 dev
->watchdog_timeo
= TX_TIMEOUT
;
886 if (type
== HOSTAP_INTERFACE_AP
) {
887 dev
->hard_start_xmit
= hostap_mgmt_start_xmit
;
888 dev
->type
= ARPHRD_IEEE80211
;
889 dev
->header_ops
= &hostap_80211_ops
;
891 dev
->hard_start_xmit
= hostap_data_start_xmit
;
894 dev
->mtu
= local
->mtu
;
895 if (type
!= HOSTAP_INTERFACE_MASTER
) {
896 /* use main radio device queue */
897 dev
->tx_queue_len
= 0;
900 SET_ETHTOOL_OPS(dev
, &prism2_ethtool_ops
);
902 netif_stop_queue(dev
);
905 static int hostap_enable_hostapd(local_info_t
*local
, int rtnl_locked
)
907 struct net_device
*dev
= local
->dev
;
912 printk(KERN_DEBUG
"%s: enabling hostapd mode\n", dev
->name
);
914 local
->apdev
= hostap_add_interface(local
, HOSTAP_INTERFACE_AP
,
915 rtnl_locked
, local
->ddev
->name
,
917 if (local
->apdev
== NULL
)
924 static int hostap_disable_hostapd(local_info_t
*local
, int rtnl_locked
)
926 struct net_device
*dev
= local
->dev
;
928 printk(KERN_DEBUG
"%s: disabling hostapd mode\n", dev
->name
);
930 hostap_remove_interface(local
->apdev
, rtnl_locked
, 1);
937 static int hostap_enable_hostapd_sta(local_info_t
*local
, int rtnl_locked
)
939 struct net_device
*dev
= local
->dev
;
944 printk(KERN_DEBUG
"%s: enabling hostapd STA mode\n", dev
->name
);
946 local
->stadev
= hostap_add_interface(local
, HOSTAP_INTERFACE_STA
,
947 rtnl_locked
, local
->ddev
->name
,
949 if (local
->stadev
== NULL
)
956 static int hostap_disable_hostapd_sta(local_info_t
*local
, int rtnl_locked
)
958 struct net_device
*dev
= local
->dev
;
960 printk(KERN_DEBUG
"%s: disabling hostapd mode\n", dev
->name
);
962 hostap_remove_interface(local
->stadev
, rtnl_locked
, 1);
963 local
->stadev
= NULL
;
969 int hostap_set_hostapd(local_info_t
*local
, int val
, int rtnl_locked
)
973 if (val
< 0 || val
> 1)
976 if (local
->hostapd
== val
)
980 ret
= hostap_enable_hostapd(local
, rtnl_locked
);
985 ret
= hostap_disable_hostapd(local
, rtnl_locked
);
994 int hostap_set_hostapd_sta(local_info_t
*local
, int val
, int rtnl_locked
)
998 if (val
< 0 || val
> 1)
1001 if (local
->hostapd_sta
== val
)
1005 ret
= hostap_enable_hostapd_sta(local
, rtnl_locked
);
1007 local
->hostapd_sta
= 1;
1009 local
->hostapd_sta
= 0;
1010 ret
= hostap_disable_hostapd_sta(local
, rtnl_locked
);
1012 local
->hostapd_sta
= 1;
1020 int prism2_update_comms_qual(struct net_device
*dev
)
1022 struct hostap_interface
*iface
;
1023 local_info_t
*local
;
1025 struct hfa384x_comms_quality sq
;
1027 iface
= netdev_priv(dev
);
1028 local
= iface
->local
;
1029 if (!local
->sta_fw_ver
)
1031 else if (local
->sta_fw_ver
>= PRISM2_FW_VER(1,3,1)) {
1032 if (local
->func
->get_rid(local
->dev
,
1033 HFA384X_RID_DBMCOMMSQUALITY
,
1034 &sq
, sizeof(sq
), 1) >= 0) {
1035 local
->comms_qual
= (s16
) le16_to_cpu(sq
.comm_qual
);
1036 local
->avg_signal
= (s16
) le16_to_cpu(sq
.signal_level
);
1037 local
->avg_noise
= (s16
) le16_to_cpu(sq
.noise_level
);
1038 local
->last_comms_qual_update
= jiffies
;
1042 if (local
->func
->get_rid(local
->dev
, HFA384X_RID_COMMSQUALITY
,
1043 &sq
, sizeof(sq
), 1) >= 0) {
1044 local
->comms_qual
= le16_to_cpu(sq
.comm_qual
);
1045 local
->avg_signal
= HFA384X_LEVEL_TO_dBm(
1046 le16_to_cpu(sq
.signal_level
));
1047 local
->avg_noise
= HFA384X_LEVEL_TO_dBm(
1048 le16_to_cpu(sq
.noise_level
));
1049 local
->last_comms_qual_update
= jiffies
;
1058 int prism2_sta_send_mgmt(local_info_t
*local
, u8
*dst
, u16 stype
,
1059 u8
*body
, size_t bodylen
)
1061 struct sk_buff
*skb
;
1062 struct hostap_ieee80211_mgmt
*mgmt
;
1063 struct hostap_skb_tx_data
*meta
;
1064 struct net_device
*dev
= local
->dev
;
1066 skb
= dev_alloc_skb(IEEE80211_MGMT_HDR_LEN
+ bodylen
);
1070 mgmt
= (struct hostap_ieee80211_mgmt
*)
1071 skb_put(skb
, IEEE80211_MGMT_HDR_LEN
);
1072 memset(mgmt
, 0, IEEE80211_MGMT_HDR_LEN
);
1073 mgmt
->frame_control
= cpu_to_le16(IEEE80211_FTYPE_MGMT
| stype
);
1074 memcpy(mgmt
->da
, dst
, ETH_ALEN
);
1075 memcpy(mgmt
->sa
, dev
->dev_addr
, ETH_ALEN
);
1076 memcpy(mgmt
->bssid
, dst
, ETH_ALEN
);
1078 memcpy(skb_put(skb
, bodylen
), body
, bodylen
);
1080 meta
= (struct hostap_skb_tx_data
*) skb
->cb
;
1081 memset(meta
, 0, sizeof(*meta
));
1082 meta
->magic
= HOSTAP_SKB_TX_DATA_MAGIC
;
1083 meta
->iface
= netdev_priv(dev
);
1086 skb_reset_mac_header(skb
);
1087 skb_reset_network_header(skb
);
1088 dev_queue_xmit(skb
);
1094 int prism2_sta_deauth(local_info_t
*local
, u16 reason
)
1096 union iwreq_data wrqu
;
1098 __le16 val
= cpu_to_le16(reason
);
1100 if (local
->iw_mode
!= IW_MODE_INFRA
||
1101 memcmp(local
->bssid
, "\x00\x00\x00\x00\x00\x00", ETH_ALEN
) == 0 ||
1102 memcmp(local
->bssid
, "\x44\x44\x44\x44\x44\x44", ETH_ALEN
) == 0)
1105 ret
= prism2_sta_send_mgmt(local
, local
->bssid
, IEEE80211_STYPE_DEAUTH
,
1107 memset(wrqu
.ap_addr
.sa_data
, 0, ETH_ALEN
);
1108 wireless_send_event(local
->dev
, SIOCGIWAP
, &wrqu
, NULL
);
1113 struct proc_dir_entry
*hostap_proc
;
1115 static int __init
hostap_init(void)
1117 if (init_net
.proc_net
!= NULL
) {
1118 hostap_proc
= proc_mkdir("hostap", init_net
.proc_net
);
1120 printk(KERN_WARNING
"Failed to mkdir "
1121 "/proc/net/hostap\n");
1129 static void __exit
hostap_exit(void)
1131 if (hostap_proc
!= NULL
) {
1133 remove_proc_entry("hostap", init_net
.proc_net
);
1138 EXPORT_SYMBOL(hostap_set_word
);
1139 EXPORT_SYMBOL(hostap_set_string
);
1140 EXPORT_SYMBOL(hostap_get_porttype
);
1141 EXPORT_SYMBOL(hostap_set_encryption
);
1142 EXPORT_SYMBOL(hostap_set_antsel
);
1143 EXPORT_SYMBOL(hostap_set_roaming
);
1144 EXPORT_SYMBOL(hostap_set_auth_algs
);
1145 EXPORT_SYMBOL(hostap_dump_rx_header
);
1146 EXPORT_SYMBOL(hostap_dump_tx_header
);
1147 EXPORT_SYMBOL(hostap_80211_header_parse
);
1148 EXPORT_SYMBOL(hostap_80211_get_hdrlen
);
1149 EXPORT_SYMBOL(hostap_get_stats
);
1150 EXPORT_SYMBOL(hostap_setup_dev
);
1151 EXPORT_SYMBOL(hostap_set_multicast_list_queue
);
1152 EXPORT_SYMBOL(hostap_set_hostapd
);
1153 EXPORT_SYMBOL(hostap_set_hostapd_sta
);
1154 EXPORT_SYMBOL(hostap_add_interface
);
1155 EXPORT_SYMBOL(hostap_remove_interface
);
1156 EXPORT_SYMBOL(prism2_update_comms_qual
);
1158 module_init(hostap_init
);
1159 module_exit(hostap_exit
);