1 /******************************************************************************
2 * Copyright(c) 2008 - 2010 Realtek Corporation. All rights reserved.
3 * Linux device driver for RTL8192U
5 * Based on the r8187 driver, which is:
6 * Copyright 2004-2005 Andrea Merello <andrea.merello@gmail.com>, et al.
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms of version 2 of the GNU General Public License as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * You should have received a copy of the GNU General Public License along with
17 * this program; if not, write to the Free Software Foundation, Inc.,
18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
20 * The full GNU General Public License is included in this distribution in the
21 * file called LICENSE.
23 * Contact Information:
24 * Jerry chuang <wlanfae@realtek.com>
27 #ifndef CONFIG_FORCE_HARD_FLOAT
28 double __floatsidf(int i
)
33 unsigned int __fixunsdfsi(double d
)
38 double __adddf3(double a
, double b
)
43 double __addsf3(float a
, float b
)
48 double __subdf3(double a
, double b
)
53 double __extendsfdf2(float a
)
59 #define CONFIG_RTL8192_IO_MAP
61 #include <linux/uaccess.h>
62 #include "r8192U_hw.h"
64 #include "r8190_rtl8256.h" /* RTL8225 Radio frontend */
65 #include "r8180_93cx6.h" /* Card EEPROM */
66 #include "r8192U_wx.h"
67 #include "r819xU_phy.h"
68 #include "r819xU_phyreg.h"
69 #include "r819xU_cmdpkt.h"
70 #include "r8192U_dm.h"
71 #include <linux/usb.h>
72 #include <linux/slab.h>
73 #include <linux/proc_fs.h>
74 #include <linux/seq_file.h>
75 /* FIXME: check if 2.6.7 is ok */
78 /* set here to open your trace code. */
79 u32 rt_global_debug_component
= COMP_DOWN
|
81 COMP_ERR
; /* always open err flags on */
83 #define TOTAL_CAM_ENTRY 32
84 #define CAM_CONTENT_COUNT 8
86 static const struct usb_device_id rtl8192_usb_id_tbl
[] = {
88 {USB_DEVICE(0x0bda, 0x8709)},
90 {USB_DEVICE(0x07aa, 0x0043)},
92 {USB_DEVICE(0x050d, 0x805E)},
94 {USB_DEVICE(0x0df6, 0x0031)},
96 {USB_DEVICE(0x1740, 0x9201)},
98 {USB_DEVICE(0x2001, 0x3301)},
100 {USB_DEVICE(0x5a57, 0x0290)},
102 {USB_DEVICE(0x043e, 0x7a01)},
106 MODULE_LICENSE("GPL");
107 MODULE_VERSION("V 1.1");
108 MODULE_DEVICE_TABLE(usb
, rtl8192_usb_id_tbl
);
109 MODULE_DESCRIPTION("Linux driver for Realtek RTL8192 USB WiFi cards");
111 static char *ifname
= "wlan%d";
112 static int hwwep
= 1; /* default use hw. set 0 to use software security */
113 static int channels
= 0x3fff;
117 module_param(ifname
, charp
, S_IRUGO
| S_IWUSR
);
118 module_param(hwwep
, int, S_IRUGO
| S_IWUSR
);
119 module_param(channels
, int, S_IRUGO
| S_IWUSR
);
121 MODULE_PARM_DESC(ifname
, " Net interface name, wlan%d=default");
122 MODULE_PARM_DESC(hwwep
, " Try to use hardware security support. ");
123 MODULE_PARM_DESC(channels
, " Channel bitmask for specific locales. NYI");
125 static int rtl8192_usb_probe(struct usb_interface
*intf
,
126 const struct usb_device_id
*id
);
127 static void rtl8192_usb_disconnect(struct usb_interface
*intf
);
130 static struct usb_driver rtl8192_usb_driver
= {
131 .name
= RTL819xU_MODULE_NAME
, /* Driver name */
132 .id_table
= rtl8192_usb_id_tbl
, /* PCI_ID table */
133 .probe
= rtl8192_usb_probe
, /* probe fn */
134 .disconnect
= rtl8192_usb_disconnect
, /* remove fn */
135 .suspend
= NULL
, /* PM suspend fn */
136 .resume
= NULL
, /* PM resume fn */
140 struct CHANNEL_LIST
{
145 static struct CHANNEL_LIST ChannelPlan
[] = {
147 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 36, 40, 44, 48, 52, 56, 60, 64, 149, 153, 157, 161, 165}, 24},
149 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11}, 11},
151 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 36, 40, 44, 48, 52, 56, 60, 64}, 21},
152 /* Spain. Change to ETSI. */
153 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
154 /* France. Change to ETSI. */
155 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
157 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22},
159 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22},
161 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13}, 13},
162 /* For 11a , TELEC */
163 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22},
165 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 36, 40, 44, 48, 52, 56, 60, 64}, 22},
166 /* For Global Domain. 1-11:active scan, 12-14 passive scan. */
167 {{1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14}, 14}
170 static void rtl819x_set_channel_map(u8 channel_plan
, struct r8192_priv
*priv
)
172 int i
, max_chan
= -1, min_chan
= -1;
173 struct ieee80211_device
*ieee
= priv
->ieee80211
;
175 switch (channel_plan
) {
176 case COUNTRY_CODE_FCC
:
177 case COUNTRY_CODE_IC
:
178 case COUNTRY_CODE_ETSI
:
179 case COUNTRY_CODE_SPAIN
:
180 case COUNTRY_CODE_FRANCE
:
181 case COUNTRY_CODE_MKK
:
182 case COUNTRY_CODE_MKK1
:
183 case COUNTRY_CODE_ISRAEL
:
184 case COUNTRY_CODE_TELEC
:
185 case COUNTRY_CODE_MIC
:
187 ieee
->bGlobalDomain
= false;
188 /* actually 8225 & 8256 rf chips only support B,G,24N mode */
189 if ((priv
->rf_chip
== RF_8225
) || (priv
->rf_chip
== RF_8256
)) {
194 "unknown rf chip, can't set channel map in function:%s()\n",
197 if (ChannelPlan
[channel_plan
].Len
!= 0) {
198 /* Clear old channel map */
199 memset(GET_DOT11D_INFO(ieee
)->channel_map
, 0,
200 sizeof(GET_DOT11D_INFO(ieee
)->channel_map
));
201 /* Set new channel map */
202 for (i
= 0; i
< ChannelPlan
[channel_plan
].Len
; i
++) {
203 if (ChannelPlan
[channel_plan
].Channel
[i
] < min_chan
|| ChannelPlan
[channel_plan
].Channel
[i
] > max_chan
)
205 GET_DOT11D_INFO(ieee
)->channel_map
[ChannelPlan
[channel_plan
].Channel
[i
]] = 1;
210 case COUNTRY_CODE_GLOBAL_DOMAIN
:
211 /* this flag enabled to follow 11d country IE setting,
212 * otherwise, it shall follow global domain settings.
214 GET_DOT11D_INFO(ieee
)->bEnabled
= 0;
216 ieee
->bGlobalDomain
= true;
227 static void CamResetAllEntry(struct net_device
*dev
)
230 /* In static WEP, OID_ADD_KEY or OID_ADD_WEP are set before STA
231 * associate to AP. However, ResetKey is called on
232 * OID_802_11_INFRASTRUCTURE_MODE and MlmeAssociateRequest. In this
233 * condition, Cam can not be reset because upper layer will not set
234 * this static key again.
236 ulcommand
|= BIT(31) | BIT(30);
237 write_nic_dword(dev
, RWCAM
, ulcommand
);
242 void write_cam(struct net_device
*dev
, u8 addr
, u32 data
)
244 write_nic_dword(dev
, WCAMI
, data
);
245 write_nic_dword(dev
, RWCAM
, BIT(31) | BIT(16) | (addr
& 0xff));
248 u32
read_cam(struct net_device
*dev
, u8 addr
)
252 write_nic_dword(dev
, RWCAM
, 0x80000000 | (addr
& 0xff));
253 read_nic_dword(dev
, 0xa8, &data
);
257 void write_nic_byte_E(struct net_device
*dev
, int indx
, u8 data
)
260 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
261 struct usb_device
*udev
= priv
->udev
;
262 u8
*usbdata
= kzalloc(sizeof(data
), GFP_KERNEL
);
268 status
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
269 RTL8187_REQ_SET_REGS
, RTL8187_REQT_WRITE
,
270 indx
| 0xfe00, 0, usbdata
, 1, HZ
/ 2);
274 netdev_err(dev
, "write_nic_byte_E TimeOut! status: %d\n",
278 int read_nic_byte_E(struct net_device
*dev
, int indx
, u8
*data
)
281 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
282 struct usb_device
*udev
= priv
->udev
;
283 u8
*usbdata
= kzalloc(sizeof(u8
), GFP_KERNEL
);
288 status
= usb_control_msg(udev
, usb_rcvctrlpipe(udev
, 0),
289 RTL8187_REQ_GET_REGS
, RTL8187_REQT_READ
,
290 indx
| 0xfe00, 0, usbdata
, 1, HZ
/ 2);
295 netdev_err(dev
, "%s failure status: %d\n", __func__
, status
);
301 /* as 92U has extend page from 4 to 16, so modify functions below. */
302 void write_nic_byte(struct net_device
*dev
, int indx
, u8 data
)
306 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
307 struct usb_device
*udev
= priv
->udev
;
308 u8
*usbdata
= kzalloc(sizeof(data
), GFP_KERNEL
);
314 status
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
315 RTL8187_REQ_SET_REGS
, RTL8187_REQT_WRITE
,
316 (indx
& 0xff) | 0xff00, (indx
>> 8) & 0x0f,
321 netdev_err(dev
, "write_nic_byte TimeOut! status: %d\n", status
);
327 void write_nic_word(struct net_device
*dev
, int indx
, u16 data
)
332 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
333 struct usb_device
*udev
= priv
->udev
;
334 u16
*usbdata
= kzalloc(sizeof(data
), GFP_KERNEL
);
340 status
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
341 RTL8187_REQ_SET_REGS
, RTL8187_REQT_WRITE
,
342 (indx
& 0xff) | 0xff00, (indx
>> 8) & 0x0f,
347 netdev_err(dev
, "write_nic_word TimeOut! status: %d\n", status
);
352 void write_nic_dword(struct net_device
*dev
, int indx
, u32 data
)
357 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
358 struct usb_device
*udev
= priv
->udev
;
359 u32
*usbdata
= kzalloc(sizeof(data
), GFP_KERNEL
);
365 status
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
366 RTL8187_REQ_SET_REGS
, RTL8187_REQT_WRITE
,
367 (indx
& 0xff) | 0xff00, (indx
>> 8) & 0x0f,
373 netdev_err(dev
, "write_nic_dword TimeOut! status: %d\n",
380 int read_nic_byte(struct net_device
*dev
, int indx
, u8
*data
)
383 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
384 struct usb_device
*udev
= priv
->udev
;
385 u8
*usbdata
= kzalloc(sizeof(u8
), GFP_KERNEL
);
390 status
= usb_control_msg(udev
, usb_rcvctrlpipe(udev
, 0),
391 RTL8187_REQ_GET_REGS
, RTL8187_REQT_READ
,
392 (indx
& 0xff) | 0xff00, (indx
>> 8) & 0x0f,
398 netdev_err(dev
, "%s failure status: %d\n", __func__
, status
);
407 int read_nic_word(struct net_device
*dev
, int indx
, u16
*data
)
410 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
411 struct usb_device
*udev
= priv
->udev
;
412 u16
*usbdata
= kzalloc(sizeof(u16
), GFP_KERNEL
);
417 status
= usb_control_msg(udev
, usb_rcvctrlpipe(udev
, 0),
418 RTL8187_REQ_GET_REGS
, RTL8187_REQT_READ
,
419 (indx
& 0xff) | 0xff00, (indx
>> 8) & 0x0f,
425 netdev_err(dev
, "%s failure status: %d\n", __func__
, status
);
432 static int read_nic_word_E(struct net_device
*dev
, int indx
, u16
*data
)
435 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
436 struct usb_device
*udev
= priv
->udev
;
437 u16
*usbdata
= kzalloc(sizeof(u16
), GFP_KERNEL
);
442 status
= usb_control_msg(udev
, usb_rcvctrlpipe(udev
, 0),
443 RTL8187_REQ_GET_REGS
, RTL8187_REQT_READ
,
444 indx
| 0xfe00, 0, usbdata
, 2, HZ
/ 2);
449 netdev_err(dev
, "%s failure status: %d\n", __func__
, status
);
456 int read_nic_dword(struct net_device
*dev
, int indx
, u32
*data
)
460 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
461 struct usb_device
*udev
= priv
->udev
;
462 u32
*usbdata
= kzalloc(sizeof(u32
), GFP_KERNEL
);
467 status
= usb_control_msg(udev
, usb_rcvctrlpipe(udev
, 0),
468 RTL8187_REQ_GET_REGS
, RTL8187_REQT_READ
,
469 (indx
& 0xff) | 0xff00, (indx
>> 8) & 0x0f,
475 netdev_err(dev
, "%s failure status: %d\n", __func__
, status
);
482 /* u8 read_phy_cck(struct net_device *dev, u8 adr); */
483 /* u8 read_phy_ofdm(struct net_device *dev, u8 adr); */
484 /* this might still called in what was the PHY rtl8185/rtl8192 common code
485 * plans are to possibility turn it again in one common code...
487 inline void force_pci_posting(struct net_device
*dev
)
491 static struct net_device_stats
*rtl8192_stats(struct net_device
*dev
);
492 static void rtl8192_restart(struct work_struct
*work
);
493 static void watch_dog_timer_callback(unsigned long data
);
495 /****************************************************************************
496 * -----------------------------PROCFS STUFF-------------------------
497 *****************************************************************************
500 static struct proc_dir_entry
*rtl8192_proc
;
502 static int proc_get_stats_ap(struct seq_file
*m
, void *v
)
504 struct net_device
*dev
= m
->private;
505 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
506 struct ieee80211_device
*ieee
= priv
->ieee80211
;
507 struct ieee80211_network
*target
;
509 list_for_each_entry(target
, &ieee
->network_list
, list
) {
510 const char *wpa
= "non_WPA";
512 if (target
->wpa_ie_len
> 0 || target
->rsn_ie_len
> 0)
515 seq_printf(m
, "%s %s\n", target
->ssid
, wpa
);
521 static int proc_get_registers(struct seq_file
*m
, void *v
)
523 struct net_device
*dev
= m
->private;
524 int i
, n
, max
= 0xff;
527 seq_puts(m
, "\n####################page 0##################\n ");
529 for (n
= 0; n
<= max
;) {
530 seq_printf(m
, "\nD: %2x > ", n
);
532 for (i
= 0; i
< 16 && n
<= max
; i
++, n
++) {
533 read_nic_byte(dev
, 0x000 | n
, &byte_rd
);
534 seq_printf(m
, "%2x ", byte_rd
);
538 seq_puts(m
, "\n####################page 1##################\n ");
539 for (n
= 0; n
<= max
;) {
540 seq_printf(m
, "\nD: %2x > ", n
);
542 for (i
= 0; i
< 16 && n
<= max
; i
++, n
++) {
543 read_nic_byte(dev
, 0x100 | n
, &byte_rd
);
544 seq_printf(m
, "%2x ", byte_rd
);
548 seq_puts(m
, "\n####################page 3##################\n ");
549 for (n
= 0; n
<= max
;) {
550 seq_printf(m
, "\nD: %2x > ", n
);
552 for (i
= 0; i
< 16 && n
<= max
; i
++, n
++) {
553 read_nic_byte(dev
, 0x300 | n
, &byte_rd
);
554 seq_printf(m
, "%2x ", byte_rd
);
562 static int proc_get_stats_tx(struct seq_file
*m
, void *v
)
564 struct net_device
*dev
= m
->private;
565 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
568 "TX VI priority ok int: %lu\n"
569 "TX VI priority error int: %lu\n"
570 "TX VO priority ok int: %lu\n"
571 "TX VO priority error int: %lu\n"
572 "TX BE priority ok int: %lu\n"
573 "TX BE priority error int: %lu\n"
574 "TX BK priority ok int: %lu\n"
575 "TX BK priority error int: %lu\n"
576 "TX MANAGE priority ok int: %lu\n"
577 "TX MANAGE priority error int: %lu\n"
578 "TX BEACON priority ok int: %lu\n"
579 "TX BEACON priority error int: %lu\n"
580 "TX queue resume: %lu\n"
581 "TX queue stopped?: %d\n"
582 "TX fifo overflow: %lu\n"
587 "TX VI dropped: %lu\n"
588 "TX VO dropped: %lu\n"
589 "TX BE dropped: %lu\n"
590 "TX BK dropped: %lu\n"
591 "TX total data packets %lu\n",
592 priv
->stats
.txviokint
,
594 priv
->stats
.txvookint
,
596 priv
->stats
.txbeokint
,
598 priv
->stats
.txbkokint
,
600 priv
->stats
.txmanageokint
,
601 priv
->stats
.txmanageerr
,
602 priv
->stats
.txbeaconokint
,
603 priv
->stats
.txbeaconerr
,
604 priv
->stats
.txresumed
,
605 netif_queue_stopped(dev
),
606 priv
->stats
.txoverflow
,
607 atomic_read(&(priv
->tx_pending
[VI_PRIORITY
])),
608 atomic_read(&(priv
->tx_pending
[VO_PRIORITY
])),
609 atomic_read(&(priv
->tx_pending
[BE_PRIORITY
])),
610 atomic_read(&(priv
->tx_pending
[BK_PRIORITY
])),
611 priv
->stats
.txvidrop
,
612 priv
->stats
.txvodrop
,
613 priv
->stats
.txbedrop
,
614 priv
->stats
.txbkdrop
,
615 priv
->stats
.txdatapkt
621 static int proc_get_stats_rx(struct seq_file
*m
, void *v
)
623 struct net_device
*dev
= m
->private;
624 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
628 "RX urb status error: %lu\n"
629 "RX invalid urb error: %lu\n",
630 priv
->stats
.rxoktotal
,
631 priv
->stats
.rxstaterr
,
632 priv
->stats
.rxurberr
);
637 static void rtl8192_proc_module_init(void)
639 RT_TRACE(COMP_INIT
, "Initializing proc filesystem");
640 rtl8192_proc
= proc_mkdir(RTL819xU_MODULE_NAME
, init_net
.proc_net
);
644 * seq_file wrappers for procfile show routines.
646 static int rtl8192_proc_open(struct inode
*inode
, struct file
*file
)
648 struct net_device
*dev
= proc_get_parent_data(inode
);
649 int (*show
)(struct seq_file
*, void *) = PDE_DATA(inode
);
651 return single_open(file
, show
, dev
);
654 static const struct file_operations rtl8192_proc_fops
= {
655 .open
= rtl8192_proc_open
,
658 .release
= single_release
,
662 * Table of proc files we need to create.
664 struct rtl8192_proc_file
{
666 int (*show
)(struct seq_file
*, void *);
669 static const struct rtl8192_proc_file rtl8192_proc_files
[] = {
670 { "stats-rx", &proc_get_stats_rx
},
671 { "stats-tx", &proc_get_stats_tx
},
672 { "stats-ap", &proc_get_stats_ap
},
673 { "registers", &proc_get_registers
},
677 static void rtl8192_proc_init_one(struct net_device
*dev
)
679 const struct rtl8192_proc_file
*f
;
680 struct proc_dir_entry
*dir
;
683 dir
= proc_mkdir_data(dev
->name
, 0, rtl8192_proc
, dev
);
686 "Unable to initialize /proc/net/rtl8192/%s\n",
691 for (f
= rtl8192_proc_files
; f
->name
[0]; f
++) {
692 if (!proc_create_data(f
->name
, S_IFREG
| S_IRUGO
, dir
,
693 &rtl8192_proc_fops
, f
->show
)) {
695 "Unable to initialize /proc/net/rtl8192/%s/%s\n",
703 static void rtl8192_proc_remove_one(struct net_device
*dev
)
705 remove_proc_subtree(dev
->name
, rtl8192_proc
);
708 /****************************************************************************
709 -----------------------------MISC STUFF-------------------------
710 *****************************************************************************/
712 short check_nic_enough_desc(struct net_device
*dev
, int queue_index
)
714 struct r8192_priv
*priv
= ieee80211_priv(dev
);
715 int used
= atomic_read(&priv
->tx_pending
[queue_index
]);
717 return (used
< MAX_TX_URB
);
720 static void tx_timeout(struct net_device
*dev
)
722 struct r8192_priv
*priv
= ieee80211_priv(dev
);
724 schedule_work(&priv
->reset_wq
);
727 void rtl8192_update_msr(struct net_device
*dev
)
729 struct r8192_priv
*priv
= ieee80211_priv(dev
);
732 read_nic_byte(dev
, MSR
, &msr
);
733 msr
&= ~MSR_LINK_MASK
;
735 /* do not change in link_state != WLAN_LINK_ASSOCIATED.
736 * msr must be updated if the state is ASSOCIATING.
737 * this is intentional and make sense for ad-hoc and
738 * master (see the create BSS/IBSS func)
740 if (priv
->ieee80211
->state
== IEEE80211_LINKED
) {
742 if (priv
->ieee80211
->iw_mode
== IW_MODE_INFRA
)
743 msr
|= (MSR_LINK_MANAGED
<< MSR_LINK_SHIFT
);
744 else if (priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
)
745 msr
|= (MSR_LINK_ADHOC
<< MSR_LINK_SHIFT
);
746 else if (priv
->ieee80211
->iw_mode
== IW_MODE_MASTER
)
747 msr
|= (MSR_LINK_MASTER
<< MSR_LINK_SHIFT
);
750 msr
|= (MSR_LINK_NONE
<< MSR_LINK_SHIFT
);
753 write_nic_byte(dev
, MSR
, msr
);
756 void rtl8192_set_chan(struct net_device
*dev
, short ch
)
758 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
760 RT_TRACE(COMP_CH
, "=====>%s()====ch:%d\n", __func__
, ch
);
763 /* this hack should avoid frame TX during channel setting*/
765 /* need to implement rf set channel here */
767 if (priv
->rf_set_chan
)
768 priv
->rf_set_chan(dev
, priv
->chan
);
772 static void rtl8192_rx_isr(struct urb
*urb
);
774 static u32
get_rxpacket_shiftbytes_819xusb(struct ieee80211_rx_stats
*pstats
)
777 return (sizeof(rx_desc_819x_usb
) + pstats
->RxDrvInfoSize
778 + pstats
->RxBufShift
);
781 static int rtl8192_rx_initiate(struct net_device
*dev
)
783 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
786 struct rtl8192_rx_info
*info
;
788 /* nomal packet rx procedure */
789 while (skb_queue_len(&priv
->rx_queue
) < MAX_RX_URB
) {
790 skb
= __dev_alloc_skb(RX_URB_SIZE
, GFP_KERNEL
);
793 entry
= usb_alloc_urb(0, GFP_KERNEL
);
798 usb_fill_bulk_urb(entry
, priv
->udev
,
799 usb_rcvbulkpipe(priv
->udev
, 3),
800 skb_tail_pointer(skb
),
801 RX_URB_SIZE
, rtl8192_rx_isr
, skb
);
802 info
= (struct rtl8192_rx_info
*)skb
->cb
;
805 info
->out_pipe
= 3; /* denote rx normal packet queue */
806 skb_queue_tail(&priv
->rx_queue
, skb
);
807 usb_submit_urb(entry
, GFP_KERNEL
);
810 /* command packet rx procedure */
811 while (skb_queue_len(&priv
->rx_queue
) < MAX_RX_URB
+ 3) {
812 skb
= __dev_alloc_skb(RX_URB_SIZE
, GFP_KERNEL
);
815 entry
= usb_alloc_urb(0, GFP_KERNEL
);
820 usb_fill_bulk_urb(entry
, priv
->udev
,
821 usb_rcvbulkpipe(priv
->udev
, 9),
822 skb_tail_pointer(skb
),
823 RX_URB_SIZE
, rtl8192_rx_isr
, skb
);
824 info
= (struct rtl8192_rx_info
*)skb
->cb
;
827 info
->out_pipe
= 9; /* denote rx cmd packet queue */
828 skb_queue_tail(&priv
->rx_queue
, skb
);
829 usb_submit_urb(entry
, GFP_KERNEL
);
835 void rtl8192_set_rxconf(struct net_device
*dev
)
837 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
840 read_nic_dword(dev
, RCR
, &rxconf
);
841 rxconf
= rxconf
& ~MAC_FILTER_MASK
;
842 rxconf
= rxconf
| RCR_AMF
;
843 rxconf
= rxconf
| RCR_ADF
;
844 rxconf
= rxconf
| RCR_AB
;
845 rxconf
= rxconf
| RCR_AM
;
847 if (dev
->flags
& IFF_PROMISC
)
848 DMESG("NIC in promisc mode");
850 if (priv
->ieee80211
->iw_mode
== IW_MODE_MONITOR
||
851 dev
->flags
& IFF_PROMISC
) {
852 rxconf
= rxconf
| RCR_AAP
;
854 rxconf
= rxconf
| RCR_APM
;
855 rxconf
= rxconf
| RCR_CBSSID
;
859 if (priv
->ieee80211
->iw_mode
== IW_MODE_MONITOR
) {
860 rxconf
= rxconf
| RCR_AICV
;
861 rxconf
= rxconf
| RCR_APWRMGT
;
864 if (priv
->crcmon
== 1 && priv
->ieee80211
->iw_mode
== IW_MODE_MONITOR
)
865 rxconf
= rxconf
| RCR_ACRC32
;
868 rxconf
= rxconf
& ~RX_FIFO_THRESHOLD_MASK
;
869 rxconf
= rxconf
| (RX_FIFO_THRESHOLD_NONE
<< RX_FIFO_THRESHOLD_SHIFT
);
870 rxconf
= rxconf
& ~MAX_RX_DMA_MASK
;
871 rxconf
= rxconf
| ((u32
)7 << RCR_MXDMA_OFFSET
);
873 rxconf
= rxconf
| RCR_ONLYERLPKT
;
875 write_nic_dword(dev
, RCR
, rxconf
);
877 /* wait to be removed */
878 void rtl8192_rx_enable(struct net_device
*dev
)
880 rtl8192_rx_initiate(dev
);
884 void rtl8192_tx_enable(struct net_device
*dev
)
890 void rtl8192_rtx_disable(struct net_device
*dev
)
893 struct r8192_priv
*priv
= ieee80211_priv(dev
);
895 struct rtl8192_rx_info
*info
;
897 read_nic_byte(dev
, CMDR
, &cmd
);
898 write_nic_byte(dev
, CMDR
, cmd
& ~(CR_TE
| CR_RE
));
899 force_pci_posting(dev
);
902 while ((skb
= __skb_dequeue(&priv
->rx_queue
))) {
903 info
= (struct rtl8192_rx_info
*)skb
->cb
;
907 usb_kill_urb(info
->urb
);
911 if (skb_queue_len(&priv
->skb_queue
))
912 netdev_warn(dev
, "skb_queue not empty\n");
914 skb_queue_purge(&priv
->skb_queue
);
917 inline u16
ieeerate2rtlrate(int rate
)
949 static u16 rtl_rate
[] = {10, 20, 55, 110, 60, 90, 120, 180, 240, 360, 480, 540};
950 inline u16
rtl8192_rate2rate(short rate
)
954 return rtl_rate
[rate
];
958 /* The prototype of rx_isr has changed since one version of Linux Kernel */
959 static void rtl8192_rx_isr(struct urb
*urb
)
961 struct sk_buff
*skb
= (struct sk_buff
*)urb
->context
;
962 struct rtl8192_rx_info
*info
= (struct rtl8192_rx_info
*)skb
->cb
;
963 struct net_device
*dev
= info
->dev
;
964 struct r8192_priv
*priv
= ieee80211_priv(dev
);
965 int out_pipe
= info
->out_pipe
;
971 if (unlikely(urb
->status
)) {
973 priv
->stats
.rxstaterr
++;
974 priv
->ieee80211
->stats
.rx_errors
++;
978 skb_unlink(skb
, &priv
->rx_queue
);
979 skb_put(skb
, urb
->actual_length
);
981 skb_queue_tail(&priv
->skb_queue
, skb
);
982 tasklet_schedule(&priv
->irq_rx_tasklet
);
984 skb
= dev_alloc_skb(RX_URB_SIZE
);
985 if (unlikely(!skb
)) {
987 netdev_err(dev
, "%s(): can't alloc skb\n", __func__
);
988 /* TODO check rx queue length and refill *somewhere* */
992 usb_fill_bulk_urb(urb
, priv
->udev
,
993 usb_rcvbulkpipe(priv
->udev
, out_pipe
),
994 skb_tail_pointer(skb
),
995 RX_URB_SIZE
, rtl8192_rx_isr
, skb
);
997 info
= (struct rtl8192_rx_info
*)skb
->cb
;
1000 info
->out_pipe
= out_pipe
;
1002 urb
->transfer_buffer
= skb_tail_pointer(skb
);
1004 skb_queue_tail(&priv
->rx_queue
, skb
);
1005 err
= usb_submit_urb(urb
, GFP_ATOMIC
);
1006 if (err
&& err
!= EPERM
)
1008 "can not submit rxurb, err is %x, URB status is %x\n",
1012 static u32
rtl819xusb_rx_command_packet(struct net_device
*dev
,
1013 struct ieee80211_rx_stats
*pstats
)
1017 status
= cmpk_message_handle_rx(dev
, pstats
);
1019 DMESG("rxcommandpackethandle819xusb: It is a command packet\n");
1025 static void rtl8192_data_hard_stop(struct net_device
*dev
)
1031 static void rtl8192_data_hard_resume(struct net_device
*dev
)
1036 /* this function TX data frames when the ieee80211 stack requires this.
1037 * It checks also if we need to stop the ieee tx queue, eventually do it
1039 static void rtl8192_hard_data_xmit(struct sk_buff
*skb
, struct net_device
*dev
,
1042 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
1044 unsigned long flags
;
1045 cb_desc
*tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
1046 u8 queue_index
= tcb_desc
->queue_index
;
1048 /* shall not be referred by command packet */
1049 RTL8192U_ASSERT(queue_index
!= TXCMD_QUEUE
);
1051 spin_lock_irqsave(&priv
->tx_lock
, flags
);
1053 memcpy((unsigned char *)(skb
->cb
), &dev
, sizeof(dev
));
1054 tcb_desc
->bTxEnableFwCalcDur
= 1;
1055 skb_push(skb
, priv
->ieee80211
->tx_headroom
);
1056 ret
= rtl8192_tx(dev
, skb
);
1058 spin_unlock_irqrestore(&priv
->tx_lock
, flags
);
1061 /* This is a rough attempt to TX a frame
1062 * This is called by the ieee 80211 stack to TX management frames.
1063 * If the ring is full packet are dropped (for data frame the queue
1064 * is stopped before this can happen).
1066 static int rtl8192_hard_start_xmit(struct sk_buff
*skb
, struct net_device
*dev
)
1068 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
1070 unsigned long flags
;
1071 cb_desc
*tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
1072 u8 queue_index
= tcb_desc
->queue_index
;
1075 spin_lock_irqsave(&priv
->tx_lock
, flags
);
1077 memcpy((unsigned char *)(skb
->cb
), &dev
, sizeof(dev
));
1078 if (queue_index
== TXCMD_QUEUE
) {
1079 skb_push(skb
, USB_HWDESC_HEADER_LEN
);
1080 rtl819xU_tx_cmd(dev
, skb
);
1083 skb_push(skb
, priv
->ieee80211
->tx_headroom
);
1084 ret
= rtl8192_tx(dev
, skb
);
1087 spin_unlock_irqrestore(&priv
->tx_lock
, flags
);
1092 static void rtl8192_tx_isr(struct urb
*tx_urb
)
1094 struct sk_buff
*skb
= (struct sk_buff
*)tx_urb
->context
;
1095 struct net_device
*dev
= (struct net_device
*)(skb
->cb
);
1096 struct r8192_priv
*priv
= NULL
;
1097 cb_desc
*tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
1098 u8 queue_index
= tcb_desc
->queue_index
;
1100 priv
= ieee80211_priv(dev
);
1102 if (tcb_desc
->queue_index
!= TXCMD_QUEUE
) {
1103 if (tx_urb
->status
== 0) {
1104 dev
->trans_start
= jiffies
;
1105 priv
->stats
.txoktotal
++;
1106 priv
->ieee80211
->LinkDetectInfo
.NumTxOkInPeriod
++;
1107 priv
->stats
.txbytesunicast
+=
1108 (skb
->len
- priv
->ieee80211
->tx_headroom
);
1110 priv
->ieee80211
->stats
.tx_errors
++;
1115 /* free skb and tx_urb */
1117 dev_kfree_skb_any(skb
);
1118 usb_free_urb(tx_urb
);
1119 atomic_dec(&priv
->tx_pending
[queue_index
]);
1124 * We had transfer our beacon frame to host controller at this moment.
1128 * Handling the wait queue of command packets.
1129 * For Tx command packets, we must not do TCB fragment because it is
1130 * not handled right now. We must cut the packets to match the size of
1131 * TX_CMD_PKT before we send it.
1134 /* Handle MPDU in wait queue. */
1135 if (queue_index
!= BEACON_QUEUE
) {
1136 /* Don't send data frame during scanning.*/
1137 if ((skb_queue_len(&priv
->ieee80211
->skb_waitQ
[queue_index
]) != 0) &&
1138 (!(priv
->ieee80211
->queue_stop
))) {
1139 skb
= skb_dequeue(&(priv
->ieee80211
->skb_waitQ
[queue_index
]));
1141 priv
->ieee80211
->softmac_hard_start_xmit(skb
,
1144 return; /* avoid further processing AMSDU */
1150 static void rtl8192_config_rate(struct net_device
*dev
, u16
*rate_config
)
1152 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1153 struct ieee80211_network
*net
;
1154 u8 i
= 0, basic_rate
= 0;
1156 net
= &priv
->ieee80211
->current_network
;
1158 for (i
= 0; i
< net
->rates_len
; i
++) {
1159 basic_rate
= net
->rates
[i
] & 0x7f;
1160 switch (basic_rate
) {
1162 *rate_config
|= RRSR_1M
;
1165 *rate_config
|= RRSR_2M
;
1168 *rate_config
|= RRSR_5_5M
;
1171 *rate_config
|= RRSR_11M
;
1174 *rate_config
|= RRSR_6M
;
1177 *rate_config
|= RRSR_9M
;
1180 *rate_config
|= RRSR_12M
;
1183 *rate_config
|= RRSR_18M
;
1186 *rate_config
|= RRSR_24M
;
1189 *rate_config
|= RRSR_36M
;
1192 *rate_config
|= RRSR_48M
;
1195 *rate_config
|= RRSR_54M
;
1199 for (i
= 0; i
< net
->rates_ex_len
; i
++) {
1200 basic_rate
= net
->rates_ex
[i
] & 0x7f;
1201 switch (basic_rate
) {
1203 *rate_config
|= RRSR_1M
;
1206 *rate_config
|= RRSR_2M
;
1209 *rate_config
|= RRSR_5_5M
;
1212 *rate_config
|= RRSR_11M
;
1215 *rate_config
|= RRSR_6M
;
1218 *rate_config
|= RRSR_9M
;
1221 *rate_config
|= RRSR_12M
;
1224 *rate_config
|= RRSR_18M
;
1227 *rate_config
|= RRSR_24M
;
1230 *rate_config
|= RRSR_36M
;
1233 *rate_config
|= RRSR_48M
;
1236 *rate_config
|= RRSR_54M
;
1243 #define SHORT_SLOT_TIME 9
1244 #define NON_SHORT_SLOT_TIME 20
1246 static void rtl8192_update_cap(struct net_device
*dev
, u16 cap
)
1249 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1250 struct ieee80211_network
*net
= &priv
->ieee80211
->current_network
;
1252 priv
->short_preamble
= cap
& WLAN_CAPABILITY_SHORT_PREAMBLE
;
1253 tmp
= priv
->basic_rate
;
1254 if (priv
->short_preamble
)
1255 tmp
|= BRSR_AckShortPmb
;
1256 write_nic_dword(dev
, RRSR
, tmp
);
1258 if (net
->mode
& (IEEE_G
| IEEE_N_24G
)) {
1261 if ((cap
& WLAN_CAPABILITY_SHORT_SLOT
) &&
1262 (!priv
->ieee80211
->pHTInfo
->bCurrentRT2RTLongSlotTime
))
1263 /* short slot time */
1264 slot_time
= SHORT_SLOT_TIME
;
1265 else /* long slot time */
1266 slot_time
= NON_SHORT_SLOT_TIME
;
1267 priv
->slot_time
= slot_time
;
1268 write_nic_byte(dev
, SLOT_TIME
, slot_time
);
1272 static void rtl8192_net_update(struct net_device
*dev
)
1275 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1276 struct ieee80211_network
*net
;
1277 u16 BcnTimeCfg
= 0, BcnCW
= 6, BcnIFS
= 0xf;
1278 u16 rate_config
= 0;
1280 net
= &priv
->ieee80211
->current_network
;
1282 rtl8192_config_rate(dev
, &rate_config
);
1283 priv
->basic_rate
= rate_config
& 0x15f;
1285 write_nic_dword(dev
, BSSIDR
, ((u32
*)net
->bssid
)[0]);
1286 write_nic_word(dev
, BSSIDR
+ 4, ((u16
*)net
->bssid
)[2]);
1288 rtl8192_update_msr(dev
);
1289 if (priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
) {
1290 write_nic_word(dev
, ATIMWND
, 2);
1291 write_nic_word(dev
, BCN_DMATIME
, 1023);
1292 write_nic_word(dev
, BCN_INTERVAL
, net
->beacon_interval
);
1293 write_nic_word(dev
, BCN_DRV_EARLY_INT
, 1);
1294 write_nic_byte(dev
, BCN_ERR_THRESH
, 100);
1295 BcnTimeCfg
|= (BcnCW
<< BCN_TCFG_CW_SHIFT
);
1296 /* TODO: BcnIFS may required to be changed on ASIC */
1297 BcnTimeCfg
|= BcnIFS
<< BCN_TCFG_IFS
;
1299 write_nic_word(dev
, BCN_TCFG
, BcnTimeCfg
);
1306 /* temporary hw beacon is not used any more.
1307 * open it when necessary
1309 void rtl819xusb_beacon_tx(struct net_device
*dev
, u16 tx_rate
)
1313 inline u8
rtl8192_IsWirelessBMode(u16 rate
)
1315 if (((rate
<= 110) && (rate
!= 60) && (rate
!= 90)) || (rate
== 220))
1321 short rtl819xU_tx_cmd(struct net_device
*dev
, struct sk_buff
*skb
)
1323 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1326 unsigned int idx_pipe
;
1327 tx_desc_cmd_819x_usb
*pdesc
= (tx_desc_cmd_819x_usb
*)skb
->data
;
1328 cb_desc
*tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
1329 u8 queue_index
= tcb_desc
->queue_index
;
1331 atomic_inc(&priv
->tx_pending
[queue_index
]);
1332 tx_urb
= usb_alloc_urb(0, GFP_ATOMIC
);
1338 memset(pdesc
, 0, USB_HWDESC_HEADER_LEN
);
1339 /* Tx descriptor ought to be set according to the skb->cb */
1340 pdesc
->FirstSeg
= 1;
1342 pdesc
->CmdInit
= tcb_desc
->bCmdOrInit
;
1343 pdesc
->TxBufferSize
= tcb_desc
->txbuf_size
;
1345 pdesc
->LINIP
= tcb_desc
->bLastIniPkt
;
1347 /*---------------------------------------------------------------------
1348 * Fill up USB_OUT_CONTEXT.
1349 *---------------------------------------------------------------------
1352 usb_fill_bulk_urb(tx_urb
, priv
->udev
,
1353 usb_sndbulkpipe(priv
->udev
, idx_pipe
),
1354 skb
->data
, skb
->len
, rtl8192_tx_isr
, skb
);
1356 status
= usb_submit_urb(tx_urb
, GFP_ATOMIC
);
1361 DMESGE("Error TX CMD URB, error %d", status
);
1366 * Mapping Software/Hardware descriptor queue id to "Queue Select Field"
1367 * in TxFwInfo data structure
1368 * 2006.10.30 by Emily
1370 * \param QUEUEID Software Queue
1372 static u8
MapHwQueueToFirmwareQueue(u8 QueueID
)
1374 u8 QueueSelect
= 0x0; /* defualt set to */
1378 QueueSelect
= QSLT_BE
;
1382 QueueSelect
= QSLT_BK
;
1386 QueueSelect
= QSLT_VO
;
1390 QueueSelect
= QSLT_VI
;
1393 QueueSelect
= QSLT_MGNT
;
1397 QueueSelect
= QSLT_BEACON
;
1400 /* TODO: mark other queue selection until we verify it is OK */
1401 /* TODO: Remove Assertions */
1403 QueueSelect
= QSLT_CMD
;
1406 QueueSelect
= QSLT_HIGH
;
1411 "TransmitTCB(): Impossible Queue Selection: %d\n",
1418 static u8
MRateToHwRate8190Pci(u8 rate
)
1420 u8 ret
= DESC90_RATE1M
;
1424 ret
= DESC90_RATE1M
;
1427 ret
= DESC90_RATE2M
;
1430 ret
= DESC90_RATE5_5M
;
1433 ret
= DESC90_RATE11M
;
1436 ret
= DESC90_RATE6M
;
1439 ret
= DESC90_RATE9M
;
1442 ret
= DESC90_RATE12M
;
1445 ret
= DESC90_RATE18M
;
1448 ret
= DESC90_RATE24M
;
1451 ret
= DESC90_RATE36M
;
1454 ret
= DESC90_RATE48M
;
1457 ret
= DESC90_RATE54M
;
1460 /* HT rate since here */
1462 ret
= DESC90_RATEMCS0
;
1465 ret
= DESC90_RATEMCS1
;
1468 ret
= DESC90_RATEMCS2
;
1471 ret
= DESC90_RATEMCS3
;
1474 ret
= DESC90_RATEMCS4
;
1477 ret
= DESC90_RATEMCS5
;
1480 ret
= DESC90_RATEMCS6
;
1483 ret
= DESC90_RATEMCS7
;
1486 ret
= DESC90_RATEMCS8
;
1489 ret
= DESC90_RATEMCS9
;
1492 ret
= DESC90_RATEMCS10
;
1495 ret
= DESC90_RATEMCS11
;
1498 ret
= DESC90_RATEMCS12
;
1501 ret
= DESC90_RATEMCS13
;
1504 ret
= DESC90_RATEMCS14
;
1507 ret
= DESC90_RATEMCS15
;
1510 ret
= DESC90_RATEMCS32
;
1520 static u8
QueryIsShort(u8 TxHT
, u8 TxRate
, cb_desc
*tcb_desc
)
1524 tmp_Short
= (TxHT
== 1) ?
1525 ((tcb_desc
->bUseShortGI
) ? 1 : 0) :
1526 ((tcb_desc
->bUseShortPreamble
) ? 1 : 0);
1528 if (TxHT
== 1 && TxRate
!= DESC90_RATEMCS15
)
1534 static void tx_zero_isr(struct urb
*tx_urb
)
1539 * The tx procedure is just as following,
1540 * skb->cb will contain all the following information,
1541 * priority, morefrag, rate, &dev.
1543 short rtl8192_tx(struct net_device
*dev
, struct sk_buff
*skb
)
1545 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1546 cb_desc
*tcb_desc
= (cb_desc
*)(skb
->cb
+ MAX_DEV_ADDR_SIZE
);
1547 tx_desc_819x_usb
*tx_desc
= (tx_desc_819x_usb
*)skb
->data
;
1548 tx_fwinfo_819x_usb
*tx_fwinfo
=
1549 (tx_fwinfo_819x_usb
*)(skb
->data
+ USB_HWDESC_HEADER_LEN
);
1550 struct usb_device
*udev
= priv
->udev
;
1553 struct urb
*tx_urb
= NULL
, *tx_urb_zero
= NULL
;
1554 unsigned int idx_pipe
;
1556 pend
= atomic_read(&priv
->tx_pending
[tcb_desc
->queue_index
]);
1557 /* we are locked here so the two atomic_read and inc are executed
1558 * without interleaves
1559 * !!! For debug purpose
1561 if (pend
> MAX_TX_URB
) {
1562 netdev_dbg(dev
, "To discard skb packet!\n");
1563 dev_kfree_skb_any(skb
);
1567 tx_urb
= usb_alloc_urb(0, GFP_ATOMIC
);
1569 dev_kfree_skb_any(skb
);
1573 /* Fill Tx firmware info */
1574 memset(tx_fwinfo
, 0, sizeof(tx_fwinfo_819x_usb
));
1576 tx_fwinfo
->TxHT
= (tcb_desc
->data_rate
& 0x80) ? 1 : 0;
1577 tx_fwinfo
->TxRate
= MRateToHwRate8190Pci(tcb_desc
->data_rate
);
1578 tx_fwinfo
->EnableCPUDur
= tcb_desc
->bTxEnableFwCalcDur
;
1579 tx_fwinfo
->Short
= QueryIsShort(tx_fwinfo
->TxHT
, tx_fwinfo
->TxRate
,
1581 if (tcb_desc
->bAMPDUEnable
) { /* AMPDU enabled */
1582 tx_fwinfo
->AllowAggregation
= 1;
1584 tx_fwinfo
->RxMF
= tcb_desc
->ampdu_factor
;
1585 tx_fwinfo
->RxAMD
= tcb_desc
->ampdu_density
& 0x07;
1587 tx_fwinfo
->AllowAggregation
= 0;
1589 tx_fwinfo
->RxMF
= 0;
1590 tx_fwinfo
->RxAMD
= 0;
1593 /* Protection mode related */
1594 tx_fwinfo
->RtsEnable
= (tcb_desc
->bRTSEnable
) ? 1 : 0;
1595 tx_fwinfo
->CtsEnable
= (tcb_desc
->bCTSEnable
) ? 1 : 0;
1596 tx_fwinfo
->RtsSTBC
= (tcb_desc
->bRTSSTBC
) ? 1 : 0;
1597 tx_fwinfo
->RtsHT
= (tcb_desc
->rts_rate
& 0x80) ? 1 : 0;
1598 tx_fwinfo
->RtsRate
= MRateToHwRate8190Pci((u8
)tcb_desc
->rts_rate
);
1599 tx_fwinfo
->RtsSubcarrier
= (tx_fwinfo
->RtsHT
== 0) ? (tcb_desc
->RTSSC
) : 0;
1600 tx_fwinfo
->RtsBandwidth
= (tx_fwinfo
->RtsHT
== 1) ? ((tcb_desc
->bRTSBW
) ? 1 : 0) : 0;
1601 tx_fwinfo
->RtsShort
= (tx_fwinfo
->RtsHT
== 0) ? (tcb_desc
->bRTSUseShortPreamble
? 1 : 0) :
1602 (tcb_desc
->bRTSUseShortGI
? 1 : 0);
1604 /* Set Bandwidth and sub-channel settings. */
1605 if (priv
->CurrentChannelBW
== HT_CHANNEL_WIDTH_20_40
) {
1606 if (tcb_desc
->bPacketBW
) {
1607 tx_fwinfo
->TxBandwidth
= 1;
1608 /* use duplicated mode */
1609 tx_fwinfo
->TxSubCarrier
= 0;
1611 tx_fwinfo
->TxBandwidth
= 0;
1612 tx_fwinfo
->TxSubCarrier
= priv
->nCur40MhzPrimeSC
;
1615 tx_fwinfo
->TxBandwidth
= 0;
1616 tx_fwinfo
->TxSubCarrier
= 0;
1619 /* Fill Tx descriptor */
1620 memset(tx_desc
, 0, sizeof(tx_desc_819x_usb
));
1623 tx_desc
->CmdInit
= 1;
1624 tx_desc
->Offset
= sizeof(tx_fwinfo_819x_usb
) + 8;
1625 tx_desc
->PktSize
= (skb
->len
- TX_PACKET_SHIFT_BYTES
) & 0xffff;
1628 tx_desc
->SecCAMID
= 0;
1629 tx_desc
->RATid
= tcb_desc
->RATRIndex
;
1631 tx_desc
->SecType
= 0x0;
1632 if (tcb_desc
->bHwSec
) {
1633 switch (priv
->ieee80211
->pairwise_key_type
) {
1634 case KEY_TYPE_WEP40
:
1635 case KEY_TYPE_WEP104
:
1636 tx_desc
->SecType
= 0x1;
1640 tx_desc
->SecType
= 0x2;
1644 tx_desc
->SecType
= 0x3;
1648 tx_desc
->SecType
= 0x0;
1654 tx_desc
->QueueSelect
= MapHwQueueToFirmwareQueue(tcb_desc
->queue_index
);
1655 tx_desc
->TxFWInfoSize
= sizeof(tx_fwinfo_819x_usb
);
1657 tx_desc
->DISFB
= tcb_desc
->bTxDisableRateFallBack
;
1658 tx_desc
->USERATE
= tcb_desc
->bTxUseDriverAssingedRate
;
1660 /* Fill fields that are required to be initialized in
1661 * all of the descriptors
1664 tx_desc
->FirstSeg
= 1;
1665 tx_desc
->LastSeg
= 1;
1669 tx_desc
->TxBufferSize
= (u32
)(skb
->len
- USB_HWDESC_HEADER_LEN
);
1672 /* To submit bulk urb */
1673 usb_fill_bulk_urb(tx_urb
, udev
,
1674 usb_sndbulkpipe(udev
, idx_pipe
), skb
->data
,
1675 skb
->len
, rtl8192_tx_isr
, skb
);
1677 status
= usb_submit_urb(tx_urb
, GFP_ATOMIC
);
1679 /* We need to send 0 byte packet whenever
1680 * 512N bytes/64N(HIGN SPEED/NORMAL SPEED) bytes packet has
1681 * been transmitted. Otherwise, it will be halt to wait for
1684 bool bSend0Byte
= false;
1687 if (udev
->speed
== USB_SPEED_HIGH
) {
1688 if (skb
->len
> 0 && skb
->len
% 512 == 0)
1691 if (skb
->len
> 0 && skb
->len
% 64 == 0)
1695 tx_urb_zero
= usb_alloc_urb(0, GFP_ATOMIC
);
1698 "can't alloc urb for zero byte\n");
1701 usb_fill_bulk_urb(tx_urb_zero
, udev
,
1702 usb_sndbulkpipe(udev
, idx_pipe
),
1703 &zero
, 0, tx_zero_isr
, dev
);
1704 status
= usb_submit_urb(tx_urb_zero
, GFP_ATOMIC
);
1707 "Error TX URB for zero byte %d, error %d",
1708 atomic_read(&priv
->tx_pending
[tcb_desc
->queue_index
]),
1713 dev
->trans_start
= jiffies
;
1714 atomic_inc(&priv
->tx_pending
[tcb_desc
->queue_index
]);
1718 RT_TRACE(COMP_ERR
, "Error TX URB %d, error %d",
1719 atomic_read(&priv
->tx_pending
[tcb_desc
->queue_index
]),
1724 static short rtl8192_usb_initendpoints(struct net_device
*dev
)
1726 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1728 priv
->rx_urb
= kmalloc(sizeof(struct urb
*) * (MAX_RX_URB
+ 1),
1730 if (priv
->rx_urb
== NULL
)
1733 #ifndef JACKSON_NEW_RX
1734 for (i
= 0; i
< (MAX_RX_URB
+ 1); i
++) {
1736 priv
->rx_urb
[i
] = usb_alloc_urb(0, GFP_KERNEL
);
1738 priv
->rx_urb
[i
]->transfer_buffer
=
1739 kmalloc(RX_URB_SIZE
, GFP_KERNEL
);
1741 priv
->rx_urb
[i
]->transfer_buffer_length
= RX_URB_SIZE
;
1745 #ifdef THOMAS_BEACON
1748 void *oldaddr
, *newaddr
;
1750 priv
->rx_urb
[16] = usb_alloc_urb(0, GFP_KERNEL
);
1751 priv
->oldaddr
= kmalloc(16, GFP_KERNEL
);
1752 oldaddr
= priv
->oldaddr
;
1753 align
= ((long)oldaddr
) & 3;
1755 newaddr
= oldaddr
+ 4 - align
;
1756 priv
->rx_urb
[16]->transfer_buffer_length
= 16 - 4 + align
;
1759 priv
->rx_urb
[16]->transfer_buffer_length
= 16;
1761 priv
->rx_urb
[16]->transfer_buffer
= newaddr
;
1765 memset(priv
->rx_urb
, 0, sizeof(struct urb
*) * MAX_RX_URB
);
1766 priv
->pp_rxskb
= kcalloc(MAX_RX_URB
, sizeof(struct sk_buff
*),
1768 if (!priv
->pp_rxskb
) {
1769 kfree(priv
->rx_urb
);
1771 priv
->pp_rxskb
= NULL
;
1772 priv
->rx_urb
= NULL
;
1774 DMESGE("Endpoint Alloc Failure");
1778 netdev_dbg(dev
, "End of initendpoints\n");
1782 #ifdef THOMAS_BEACON
1783 static void rtl8192_usb_deleteendpoints(struct net_device
*dev
)
1786 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1789 for (i
= 0; i
< (MAX_RX_URB
+ 1); i
++) {
1790 usb_kill_urb(priv
->rx_urb
[i
]);
1791 usb_free_urb(priv
->rx_urb
[i
]);
1793 kfree(priv
->rx_urb
);
1794 priv
->rx_urb
= NULL
;
1796 kfree(priv
->oldaddr
);
1797 priv
->oldaddr
= NULL
;
1799 kfree(priv
->pp_rxskb
);
1800 priv
->pp_rxskb
= NULL
;
1803 void rtl8192_usb_deleteendpoints(struct net_device
*dev
)
1806 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1808 #ifndef JACKSON_NEW_RX
1811 for (i
= 0; i
< (MAX_RX_URB
+ 1); i
++) {
1812 usb_kill_urb(priv
->rx_urb
[i
]);
1813 kfree(priv
->rx_urb
[i
]->transfer_buffer
);
1814 usb_free_urb(priv
->rx_urb
[i
]);
1816 kfree(priv
->rx_urb
);
1817 priv
->rx_urb
= NULL
;
1821 kfree(priv
->rx_urb
);
1822 priv
->rx_urb
= NULL
;
1823 kfree(priv
->oldaddr
);
1824 priv
->oldaddr
= NULL
;
1826 kfree(priv
->pp_rxskb
);
1833 static void rtl8192_update_ratr_table(struct net_device
*dev
);
1834 static void rtl8192_link_change(struct net_device
*dev
)
1836 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1837 struct ieee80211_device
*ieee
= priv
->ieee80211
;
1839 if (ieee
->state
== IEEE80211_LINKED
) {
1840 rtl8192_net_update(dev
);
1841 rtl8192_update_ratr_table(dev
);
1842 /* Add this as in pure N mode, wep encryption will use software
1843 * way, but there is no chance to set this as wep will not set
1844 * group key in wext.
1846 if (KEY_TYPE_WEP40
== ieee
->pairwise_key_type
||
1847 KEY_TYPE_WEP104
== ieee
->pairwise_key_type
)
1848 EnableHWSecurityConfig8192(dev
);
1850 /*update timing params*/
1851 if (ieee
->iw_mode
== IW_MODE_INFRA
|| ieee
->iw_mode
== IW_MODE_ADHOC
) {
1854 read_nic_dword(dev
, RCR
, ®
);
1855 if (priv
->ieee80211
->state
== IEEE80211_LINKED
)
1856 priv
->ReceiveConfig
= reg
|= RCR_CBSSID
;
1858 priv
->ReceiveConfig
= reg
&= ~RCR_CBSSID
;
1859 write_nic_dword(dev
, RCR
, reg
);
1863 static struct ieee80211_qos_parameters def_qos_parameters
= {
1864 {cpu_to_le16(3), cpu_to_le16(3), cpu_to_le16(3), cpu_to_le16(3)},
1865 {cpu_to_le16(7), cpu_to_le16(7), cpu_to_le16(7), cpu_to_le16(7)},
1866 {2, 2, 2, 2},/* aifs */
1867 {0, 0, 0, 0},/* flags */
1868 {0, 0, 0, 0} /* tx_op_limit */
1872 static void rtl8192_update_beacon(struct work_struct
*work
)
1874 struct r8192_priv
*priv
= container_of(work
, struct r8192_priv
,
1875 update_beacon_wq
.work
);
1876 struct net_device
*dev
= priv
->ieee80211
->dev
;
1877 struct ieee80211_device
*ieee
= priv
->ieee80211
;
1878 struct ieee80211_network
*net
= &ieee
->current_network
;
1880 if (ieee
->pHTInfo
->bCurrentHTSupport
)
1881 HTUpdateSelfAndPeerSetting(ieee
, net
);
1882 ieee
->pHTInfo
->bCurrentRT2RTLongSlotTime
=
1883 net
->bssht
.bdRT2RTLongSlotTime
;
1884 rtl8192_update_cap(dev
, net
->capability
);
1887 * background support to run QoS activate functionality
1889 static int WDCAPARA_ADD
[] = {EDCAPARA_BE
, EDCAPARA_BK
,
1890 EDCAPARA_VI
, EDCAPARA_VO
};
1891 static void rtl8192_qos_activate(struct work_struct
*work
)
1893 struct r8192_priv
*priv
= container_of(work
, struct r8192_priv
,
1895 struct net_device
*dev
= priv
->ieee80211
->dev
;
1896 struct ieee80211_qos_parameters
*qos_parameters
=
1897 &priv
->ieee80211
->current_network
.qos_data
.parameters
;
1898 u8 mode
= priv
->ieee80211
->current_network
.mode
;
1906 mutex_lock(&priv
->mutex
);
1907 if (priv
->ieee80211
->state
!= IEEE80211_LINKED
)
1910 "qos active process with associate response received\n");
1911 /* It better set slot time at first
1913 * For we just support b/g mode at present, let the slot time at
1916 * update the ac parameter to related registers
1918 for (i
= 0; i
< QOS_QUEUE_NUM
; i
++) {
1919 /* Mode G/A: slotTimeTimer = 9; Mode B: 20 */
1920 u1bAIFS
= qos_parameters
->aifs
[i
] * ((mode
& (IEEE_G
| IEEE_N_24G
)) ? 9 : 20) + aSifsTime
;
1921 u1bAIFS
<<= AC_PARAM_AIFS_OFFSET
;
1922 op_limit
= (u32
)le16_to_cpu(qos_parameters
->tx_op_limit
[i
]);
1923 op_limit
<<= AC_PARAM_TXOP_LIMIT_OFFSET
;
1924 cw_max
= (u32
)le16_to_cpu(qos_parameters
->cw_max
[i
]);
1925 cw_max
<<= AC_PARAM_ECW_MAX_OFFSET
;
1926 cw_min
= (u32
)le16_to_cpu(qos_parameters
->cw_min
[i
]);
1927 cw_min
<<= AC_PARAM_ECW_MIN_OFFSET
;
1928 u4bAcParam
= op_limit
| cw_max
| cw_min
| u1bAIFS
;
1929 write_nic_dword(dev
, WDCAPARA_ADD
[i
], u4bAcParam
);
1933 mutex_unlock(&priv
->mutex
);
1936 static int rtl8192_qos_handle_probe_response(struct r8192_priv
*priv
,
1938 struct ieee80211_network
*network
)
1941 u32 size
= sizeof(struct ieee80211_qos_parameters
);
1943 if (priv
->ieee80211
->state
!= IEEE80211_LINKED
)
1946 if (priv
->ieee80211
->iw_mode
!= IW_MODE_INFRA
)
1949 if (network
->flags
& NETWORK_HAS_QOS_MASK
) {
1950 if (active_network
&&
1951 (network
->flags
& NETWORK_HAS_QOS_PARAMETERS
))
1952 network
->qos_data
.active
= network
->qos_data
.supported
;
1954 if ((network
->qos_data
.active
== 1) && (active_network
== 1) &&
1955 (network
->flags
& NETWORK_HAS_QOS_PARAMETERS
) &&
1956 (network
->qos_data
.old_param_count
!=
1957 network
->qos_data
.param_count
)) {
1958 network
->qos_data
.old_param_count
=
1959 network
->qos_data
.param_count
;
1960 queue_work(priv
->priv_wq
, &priv
->qos_activate
);
1962 "QoS parameters change call qos_activate\n");
1965 memcpy(&priv
->ieee80211
->current_network
.qos_data
.parameters
,
1966 &def_qos_parameters
, size
);
1968 if ((network
->qos_data
.active
== 1) && (active_network
== 1)) {
1969 queue_work(priv
->priv_wq
, &priv
->qos_activate
);
1971 "QoS was disabled call qos_activate\n");
1973 network
->qos_data
.active
= 0;
1974 network
->qos_data
.supported
= 0;
1980 /* handle and manage frame from beacon and probe response */
1981 static int rtl8192_handle_beacon(struct net_device
*dev
,
1982 struct ieee80211_beacon
*beacon
,
1983 struct ieee80211_network
*network
)
1985 struct r8192_priv
*priv
= ieee80211_priv(dev
);
1987 rtl8192_qos_handle_probe_response(priv
, 1, network
);
1988 queue_delayed_work(priv
->priv_wq
, &priv
->update_beacon_wq
, 0);
1994 * handling the beaconing responses. if we get different QoS setting
1995 * off the network from the associated setting, adjust the QoS
1998 static int rtl8192_qos_association_resp(struct r8192_priv
*priv
,
1999 struct ieee80211_network
*network
)
2001 unsigned long flags
;
2002 u32 size
= sizeof(struct ieee80211_qos_parameters
);
2003 int set_qos_param
= 0;
2005 if ((priv
== NULL
) || (network
== NULL
))
2008 if (priv
->ieee80211
->state
!= IEEE80211_LINKED
)
2011 if (priv
->ieee80211
->iw_mode
!= IW_MODE_INFRA
)
2014 spin_lock_irqsave(&priv
->ieee80211
->lock
, flags
);
2015 if (network
->flags
& NETWORK_HAS_QOS_PARAMETERS
) {
2016 memcpy(&priv
->ieee80211
->current_network
.qos_data
.parameters
,
2017 &network
->qos_data
.parameters
,
2018 sizeof(struct ieee80211_qos_parameters
));
2019 priv
->ieee80211
->current_network
.qos_data
.active
= 1;
2021 /* update qos parameter for current network */
2022 priv
->ieee80211
->current_network
.qos_data
.old_param_count
=
2023 priv
->ieee80211
->current_network
.qos_data
.param_count
;
2024 priv
->ieee80211
->current_network
.qos_data
.param_count
=
2025 network
->qos_data
.param_count
;
2027 memcpy(&priv
->ieee80211
->current_network
.qos_data
.parameters
,
2028 &def_qos_parameters
, size
);
2029 priv
->ieee80211
->current_network
.qos_data
.active
= 0;
2030 priv
->ieee80211
->current_network
.qos_data
.supported
= 0;
2034 spin_unlock_irqrestore(&priv
->ieee80211
->lock
, flags
);
2036 RT_TRACE(COMP_QOS
, "%s: network->flags = %d,%d\n", __func__
,
2038 priv
->ieee80211
->current_network
.qos_data
.active
);
2039 if (set_qos_param
== 1)
2040 queue_work(priv
->priv_wq
, &priv
->qos_activate
);
2047 static int rtl8192_handle_assoc_response(
2048 struct net_device
*dev
,
2049 struct ieee80211_assoc_response_frame
*resp
,
2050 struct ieee80211_network
*network
)
2052 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2054 rtl8192_qos_association_resp(priv
, network
);
2059 static void rtl8192_update_ratr_table(struct net_device
*dev
)
2061 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2062 struct ieee80211_device
*ieee
= priv
->ieee80211
;
2063 u8
*pMcsRate
= ieee
->dot11HTOperationalRateSet
;
2067 rtl8192_config_rate(dev
, (u16
*)(&ratr_value
));
2068 ratr_value
|= (*(u16
*)(pMcsRate
)) << 12;
2069 switch (ieee
->mode
) {
2071 ratr_value
&= 0x00000FF0;
2074 ratr_value
&= 0x0000000F;
2077 ratr_value
&= 0x00000FF7;
2081 if (ieee
->pHTInfo
->PeerMimoPs
== 0) { /* MIMO_PS_STATIC */
2082 ratr_value
&= 0x0007F007;
2084 if (priv
->rf_type
== RF_1T2R
)
2085 ratr_value
&= 0x000FF007;
2087 ratr_value
&= 0x0F81F007;
2093 ratr_value
&= 0x0FFFFFFF;
2094 if (ieee
->pHTInfo
->bCurTxBW40MHz
&& ieee
->pHTInfo
->bCurShortGI40MHz
)
2095 ratr_value
|= 0x80000000;
2096 else if (!ieee
->pHTInfo
->bCurTxBW40MHz
&&
2097 ieee
->pHTInfo
->bCurShortGI20MHz
)
2098 ratr_value
|= 0x80000000;
2099 write_nic_dword(dev
, RATR0
+ rate_index
* 4, ratr_value
);
2100 write_nic_byte(dev
, UFWP
, 1);
2103 static u8 ccmp_ie
[4] = {0x00, 0x50, 0xf2, 0x04};
2104 static u8 ccmp_rsn_ie
[4] = {0x00, 0x0f, 0xac, 0x04};
2105 static bool GetNmodeSupportBySecCfg8192(struct net_device
*dev
)
2107 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2108 struct ieee80211_device
*ieee
= priv
->ieee80211
;
2109 struct ieee80211_network
*network
= &ieee
->current_network
;
2110 int wpa_ie_len
= ieee
->wpa_ie_len
;
2111 struct ieee80211_crypt_data
*crypt
;
2114 crypt
= ieee
->crypt
[ieee
->tx_keyidx
];
2115 /* we use connecting AP's capability instead of only security config
2116 * on our driver to distinguish whether it should use N mode or G mode
2118 encrypt
= (network
->capability
& WLAN_CAPABILITY_PRIVACY
) ||
2119 (ieee
->host_encrypt
&& crypt
&& crypt
->ops
&&
2120 (0 == strcmp(crypt
->ops
->name
, "WEP")));
2123 if (encrypt
&& (wpa_ie_len
== 0)) {
2124 /* wep encryption, no N mode setting */
2126 } else if ((wpa_ie_len
!= 0)) {
2127 /* parse pairwise key type */
2128 if (((ieee
->wpa_ie
[0] == 0xdd) && (!memcmp(&(ieee
->wpa_ie
[14]), ccmp_ie
, 4))) || ((ieee
->wpa_ie
[0] == 0x30) && (!memcmp(&ieee
->wpa_ie
[10], ccmp_rsn_ie
, 4))))
2139 static bool GetHalfNmodeSupportByAPs819xUsb(struct net_device
*dev
)
2141 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2143 return priv
->ieee80211
->bHalfWirelessN24GMode
;
2146 static void rtl8192_refresh_supportrate(struct r8192_priv
*priv
)
2148 struct ieee80211_device
*ieee
= priv
->ieee80211
;
2149 /* We do not consider set support rate for ABG mode, only
2150 * HT MCS rate is set here.
2152 if (ieee
->mode
== WIRELESS_MODE_N_24G
||
2153 ieee
->mode
== WIRELESS_MODE_N_5G
)
2154 memcpy(ieee
->Regdot11HTOperationalRateSet
,
2155 ieee
->RegHTSuppRateSet
, 16);
2157 memset(ieee
->Regdot11HTOperationalRateSet
, 0, 16);
2160 static u8
rtl8192_getSupportedWireleeMode(struct net_device
*dev
)
2162 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2165 switch (priv
->rf_chip
) {
2169 ret
= WIRELESS_MODE_N_24G
| WIRELESS_MODE_G
| WIRELESS_MODE_B
;
2172 ret
= WIRELESS_MODE_A
| WIRELESS_MODE_N_5G
;
2175 ret
= WIRELESS_MODE_B
;
2180 static void rtl8192_SetWirelessMode(struct net_device
*dev
, u8 wireless_mode
)
2182 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2183 u8 bSupportMode
= rtl8192_getSupportedWireleeMode(dev
);
2185 if (wireless_mode
== WIRELESS_MODE_AUTO
||
2186 (wireless_mode
& bSupportMode
) == 0) {
2187 if (bSupportMode
& WIRELESS_MODE_N_24G
) {
2188 wireless_mode
= WIRELESS_MODE_N_24G
;
2189 } else if (bSupportMode
& WIRELESS_MODE_N_5G
) {
2190 wireless_mode
= WIRELESS_MODE_N_5G
;
2191 } else if ((bSupportMode
& WIRELESS_MODE_A
)) {
2192 wireless_mode
= WIRELESS_MODE_A
;
2193 } else if ((bSupportMode
& WIRELESS_MODE_G
)) {
2194 wireless_mode
= WIRELESS_MODE_G
;
2195 } else if ((bSupportMode
& WIRELESS_MODE_B
)) {
2196 wireless_mode
= WIRELESS_MODE_B
;
2199 "%s(), No valid wireless mode supported, SupportedWirelessMode(%x)!!!\n",
2200 __func__
, bSupportMode
);
2201 wireless_mode
= WIRELESS_MODE_B
;
2205 /* TODO: this function doesn't work well at this time,
2206 * we should wait for FPGA
2208 ActUpdateChannelAccessSetting(
2209 pAdapter
, pHalData
->CurrentWirelessMode
,
2210 &pAdapter
->MgntInfo
.Info8185
.ChannelAccessSetting
);
2212 priv
->ieee80211
->mode
= wireless_mode
;
2214 if (wireless_mode
== WIRELESS_MODE_N_24G
||
2215 wireless_mode
== WIRELESS_MODE_N_5G
)
2216 priv
->ieee80211
->pHTInfo
->bEnableHT
= 1;
2218 priv
->ieee80211
->pHTInfo
->bEnableHT
= 0;
2219 RT_TRACE(COMP_INIT
, "Current Wireless Mode is %x\n", wireless_mode
);
2220 rtl8192_refresh_supportrate(priv
);
2223 /* init priv variables here. only non_zero value should be initialized here. */
2224 static void rtl8192_init_priv_variable(struct net_device
*dev
)
2226 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2229 priv
->card_8192
= NIC_8192U
;
2230 priv
->chan
= 1; /* set to channel 1 */
2231 priv
->ieee80211
->mode
= WIRELESS_MODE_AUTO
; /* SET AUTO */
2232 priv
->ieee80211
->iw_mode
= IW_MODE_INFRA
;
2233 priv
->ieee80211
->ieee_up
= 0;
2234 priv
->retry_rts
= DEFAULT_RETRY_RTS
;
2235 priv
->retry_data
= DEFAULT_RETRY_DATA
;
2236 priv
->ieee80211
->rts
= DEFAULT_RTS_THRESHOLD
;
2237 priv
->ieee80211
->rate
= 110; /* 11 mbps */
2238 priv
->ieee80211
->short_slot
= 1;
2239 priv
->promisc
= (dev
->flags
& IFF_PROMISC
) ? 1 : 0;
2241 /* for silent reset */
2242 priv
->IrpPendingCount
= 1;
2243 priv
->ResetProgress
= RESET_TYPE_NORESET
;
2244 priv
->bForcedSilentReset
= false;
2245 priv
->bDisableNormalResetCheck
= false;
2246 priv
->force_reset
= false;
2248 /* we don't use FW read/write RF until stable firmware is available. */
2249 priv
->ieee80211
->FwRWRF
= 0;
2250 priv
->ieee80211
->current_network
.beacon_interval
=
2251 DEFAULT_BEACONINTERVAL
;
2252 priv
->ieee80211
->softmac_features
= IEEE_SOFTMAC_SCAN
|
2253 IEEE_SOFTMAC_ASSOCIATE
| IEEE_SOFTMAC_PROBERQ
|
2254 IEEE_SOFTMAC_PROBERS
| IEEE_SOFTMAC_TX_QUEUE
|
2255 IEEE_SOFTMAC_BEACONS
;
2257 priv
->ieee80211
->active_scan
= 1;
2258 priv
->ieee80211
->modulation
=
2259 IEEE80211_CCK_MODULATION
| IEEE80211_OFDM_MODULATION
;
2260 priv
->ieee80211
->host_encrypt
= 1;
2261 priv
->ieee80211
->host_decrypt
= 1;
2262 priv
->ieee80211
->start_send_beacons
= NULL
;
2263 priv
->ieee80211
->stop_send_beacons
= NULL
;
2264 priv
->ieee80211
->softmac_hard_start_xmit
= rtl8192_hard_start_xmit
;
2265 priv
->ieee80211
->set_chan
= rtl8192_set_chan
;
2266 priv
->ieee80211
->link_change
= rtl8192_link_change
;
2267 priv
->ieee80211
->softmac_data_hard_start_xmit
= rtl8192_hard_data_xmit
;
2268 priv
->ieee80211
->data_hard_stop
= rtl8192_data_hard_stop
;
2269 priv
->ieee80211
->data_hard_resume
= rtl8192_data_hard_resume
;
2270 priv
->ieee80211
->init_wmmparam_flag
= 0;
2271 priv
->ieee80211
->fts
= DEFAULT_FRAG_THRESHOLD
;
2272 priv
->ieee80211
->check_nic_enough_desc
= check_nic_enough_desc
;
2273 priv
->ieee80211
->tx_headroom
= TX_PACKET_SHIFT_BYTES
;
2274 priv
->ieee80211
->qos_support
= 1;
2276 priv
->ieee80211
->SetBWModeHandler
= rtl8192_SetBWMode
;
2277 priv
->ieee80211
->handle_assoc_response
= rtl8192_handle_assoc_response
;
2278 priv
->ieee80211
->handle_beacon
= rtl8192_handle_beacon
;
2280 priv
->ieee80211
->GetNmodeSupportBySecCfg
= GetNmodeSupportBySecCfg8192
;
2281 priv
->ieee80211
->GetHalfNmodeSupportByAPsHandler
=
2282 GetHalfNmodeSupportByAPs819xUsb
;
2283 priv
->ieee80211
->SetWirelessMode
= rtl8192_SetWirelessMode
;
2285 priv
->ieee80211
->InitialGainHandler
= InitialGain819xUsb
;
2286 priv
->card_type
= USB
;
2288 if (Adapter
->bInHctTest
) {
2289 pHalData
->ShortRetryLimit
= 7;
2290 pHalData
->LongRetryLimit
= 7;
2293 priv
->ShortRetryLimit
= 0x30;
2294 priv
->LongRetryLimit
= 0x30;
2295 priv
->EarlyRxThreshold
= 7;
2296 priv
->enable_gpio0
= 0;
2297 priv
->TransmitConfig
=
2298 /* Max DMA Burst Size per Tx DMA Burst, 7: reserved. */
2299 (TCR_MXDMA_2048
<< TCR_MXDMA_OFFSET
) |
2300 /* Short retry limit */
2301 (priv
->ShortRetryLimit
<< TCR_SRL_OFFSET
) |
2302 /* Long retry limit */
2303 (priv
->LongRetryLimit
<< TCR_LRL_OFFSET
) |
2304 /* FALSE: HW provides PLCP length and LENGEXT
2305 * TRUE: SW provides them
2307 (false ? TCR_SAT
: 0);
2309 if (Adapter
->bInHctTest
)
2310 pHalData
->ReceiveConfig
=
2311 pHalData
->CSMethod
|
2312 /* accept management/data */
2314 /* accept control frame for SW
2318 /* accept BC/MC/UC */
2319 RCR_AB
| RCR_AM
| RCR_APM
|
2320 /* accept ICV/CRC error
2323 RCR_AICV
| RCR_ACRC32
|
2324 /* Max DMA Burst Size per Tx
2325 * DMA Burst, 7: unlimited.
2327 ((u32
)7 << RCR_MXDMA_OFFSET
) |
2328 /* Rx FIFO Threshold,
2329 * 7: No Rx threshold.
2331 (pHalData
->EarlyRxThreshold
<< RCR_FIFO_OFFSET
) |
2332 (pHalData
->EarlyRxThreshold
== 7 ? RCR_OnlyErlPkt
: 0);
2336 priv
->ReceiveConfig
=
2337 /* accept management/data */
2339 /* accept control frame for SW AP needs PS-poll */
2341 /* accept BC/MC/UC */
2342 RCR_AB
| RCR_AM
| RCR_APM
|
2343 /* Max DMA Burst Size per Rx DMA Burst, 7: unlimited. */
2344 ((u32
)7 << RCR_MXDMA_OFFSET
) |
2345 /* Rx FIFO Threshold, 7: No Rx threshold. */
2346 (priv
->EarlyRxThreshold
<< RX_FIFO_THRESHOLD_SHIFT
) |
2347 (priv
->EarlyRxThreshold
== 7 ? RCR_ONLYERLPKT
: 0);
2349 priv
->AcmControl
= 0;
2350 priv
->pFirmware
= kzalloc(sizeof(rt_firmware
), GFP_KERNEL
);
2352 /* rx related queue */
2353 skb_queue_head_init(&priv
->rx_queue
);
2354 skb_queue_head_init(&priv
->skb_queue
);
2356 /* Tx related queue */
2357 for (i
= 0; i
< MAX_QUEUE_SIZE
; i
++)
2358 skb_queue_head_init(&priv
->ieee80211
->skb_waitQ
[i
]);
2359 for (i
= 0; i
< MAX_QUEUE_SIZE
; i
++)
2360 skb_queue_head_init(&priv
->ieee80211
->skb_aggQ
[i
]);
2361 for (i
= 0; i
< MAX_QUEUE_SIZE
; i
++)
2362 skb_queue_head_init(&priv
->ieee80211
->skb_drv_aggQ
[i
]);
2363 priv
->rf_set_chan
= rtl8192_phy_SwChnl
;
2366 /* init lock here */
2367 static void rtl8192_init_priv_lock(struct r8192_priv
*priv
)
2369 spin_lock_init(&priv
->tx_lock
);
2370 spin_lock_init(&priv
->irq_lock
);
2371 sema_init(&priv
->wx_sem
, 1);
2372 sema_init(&priv
->rf_sem
, 1);
2373 mutex_init(&priv
->mutex
);
2376 static void rtl819x_watchdog_wqcallback(struct work_struct
*work
);
2378 static void rtl8192_irq_rx_tasklet(struct r8192_priv
*priv
);
2379 /* init tasklet and wait_queue here. only 2.6 above kernel is considered */
2380 #define DRV_NAME "wlan0"
2381 static void rtl8192_init_priv_task(struct net_device
*dev
)
2383 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2385 priv
->priv_wq
= create_workqueue(DRV_NAME
);
2387 INIT_WORK(&priv
->reset_wq
, rtl8192_restart
);
2389 INIT_DELAYED_WORK(&priv
->watch_dog_wq
,
2390 rtl819x_watchdog_wqcallback
);
2391 INIT_DELAYED_WORK(&priv
->txpower_tracking_wq
,
2392 dm_txpower_trackingcallback
);
2393 INIT_DELAYED_WORK(&priv
->rfpath_check_wq
,
2394 dm_rf_pathcheck_workitemcallback
);
2395 INIT_DELAYED_WORK(&priv
->update_beacon_wq
,
2396 rtl8192_update_beacon
);
2397 INIT_DELAYED_WORK(&priv
->initialgain_operate_wq
,
2398 InitialGainOperateWorkItemCallBack
);
2399 INIT_WORK(&priv
->qos_activate
, rtl8192_qos_activate
);
2401 tasklet_init(&priv
->irq_rx_tasklet
,
2402 (void(*)(unsigned long))rtl8192_irq_rx_tasklet
,
2403 (unsigned long)priv
);
2406 static void rtl8192_get_eeprom_size(struct net_device
*dev
)
2409 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2411 RT_TRACE(COMP_EPROM
, "===========>%s()\n", __func__
);
2412 read_nic_word_E(dev
, EPROM_CMD
, &curCR
);
2413 RT_TRACE(COMP_EPROM
,
2414 "read from Reg EPROM_CMD(%x):%x\n", EPROM_CMD
, curCR
);
2415 /* whether need I consider BIT(5?) */
2417 (curCR
& Cmd9346CR_9356SEL
) ? EPROM_93c56
: EPROM_93c46
;
2418 RT_TRACE(COMP_EPROM
,
2419 "<===========%s(), epromtype:%d\n", __func__
, priv
->epromtype
);
2422 /* used to swap endian. as ntohl & htonl are not necessary
2423 * to swap endian, so use this instead.
2425 static inline u16
endian_swap(u16
*data
)
2428 *data
= (tmp
>> 8) | (tmp
<< 8);
2431 static void rtl8192_read_eeprom_info(struct net_device
*dev
)
2434 u8 bMac_Tmp_Addr
[6] = {0x00, 0xe0, 0x4c, 0x00, 0x00, 0x02};
2435 u8 bLoad_From_EEPOM
= false;
2436 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2440 RT_TRACE(COMP_EPROM
, "===========>%s()\n", __func__
);
2441 wEPROM_ID
= eprom_read(dev
, 0); /* first read EEPROM ID out; */
2442 RT_TRACE(COMP_EPROM
, "EEPROM ID is 0x%x\n", wEPROM_ID
);
2444 if (wEPROM_ID
!= RTL8190_EEPROM_ID
)
2446 "EEPROM ID is invalid(is 0x%x(should be 0x%x)\n",
2447 wEPROM_ID
, RTL8190_EEPROM_ID
);
2449 bLoad_From_EEPOM
= true;
2451 if (bLoad_From_EEPOM
) {
2452 tmpValue
= eprom_read(dev
, EEPROM_VID
>> 1);
2453 priv
->eeprom_vid
= endian_swap(&tmpValue
);
2454 priv
->eeprom_pid
= eprom_read(dev
, EEPROM_PID
>> 1);
2455 tmpValue
= eprom_read(dev
, EEPROM_ChannelPlan
>> 1);
2456 priv
->eeprom_ChannelPlan
= (tmpValue
& 0xff00) >> 8;
2457 priv
->btxpowerdata_readfromEEPORM
= true;
2458 priv
->eeprom_CustomerID
=
2459 eprom_read(dev
, (EEPROM_Customer_ID
>> 1)) >> 8;
2461 priv
->eeprom_vid
= 0;
2462 priv
->eeprom_pid
= 0;
2463 priv
->card_8192_version
= VERSION_819xU_B
;
2464 priv
->eeprom_ChannelPlan
= 0;
2465 priv
->eeprom_CustomerID
= 0;
2467 RT_TRACE(COMP_EPROM
,
2468 "vid:0x%4x, pid:0x%4x, CustomID:0x%2x, ChanPlan:0x%x\n",
2469 priv
->eeprom_vid
, priv
->eeprom_pid
, priv
->eeprom_CustomerID
,
2470 priv
->eeprom_ChannelPlan
);
2471 /* set channelplan from eeprom */
2472 priv
->ChannelPlan
= priv
->eeprom_ChannelPlan
;
2473 if (bLoad_From_EEPOM
) {
2476 for (i
= 0; i
< 6; i
+= 2) {
2479 tmp
= eprom_read(dev
, (u16
)((EEPROM_NODE_ADDRESS_BYTE_0
+ i
) >> 1));
2480 *(u16
*)(&dev
->dev_addr
[i
]) = tmp
;
2483 memcpy(dev
->dev_addr
, bMac_Tmp_Addr
, 6);
2484 /* should I set IDR0 here? */
2486 RT_TRACE(COMP_EPROM
, "MAC addr:%pM\n", dev
->dev_addr
);
2487 priv
->rf_type
= RTL819X_DEFAULT_RF_TYPE
; /* default 1T2R */
2488 priv
->rf_chip
= RF_8256
;
2490 if (priv
->card_8192_version
== (u8
)VERSION_819xU_A
) {
2491 /* read Tx power gain offset of legacy OFDM to HT rate */
2492 if (bLoad_From_EEPOM
)
2493 priv
->EEPROMTxPowerDiff
= (eprom_read(dev
, (EEPROM_TxPowerDiff
>> 1)) & 0xff00) >> 8;
2495 priv
->EEPROMTxPowerDiff
= EEPROM_Default_TxPower
;
2496 RT_TRACE(COMP_EPROM
, "TxPowerDiff:%d\n", priv
->EEPROMTxPowerDiff
);
2497 /* read ThermalMeter from EEPROM */
2498 if (bLoad_From_EEPOM
)
2499 priv
->EEPROMThermalMeter
= (u8
)(eprom_read(dev
, (EEPROM_ThermalMeter
>> 1)) & 0x00ff);
2501 priv
->EEPROMThermalMeter
= EEPROM_Default_ThermalMeter
;
2502 RT_TRACE(COMP_EPROM
, "ThermalMeter:%d\n", priv
->EEPROMThermalMeter
);
2503 /* for tx power track */
2504 priv
->TSSI_13dBm
= priv
->EEPROMThermalMeter
* 100;
2505 /* read antenna tx power offset of B/C/D to A from EEPROM */
2506 if (bLoad_From_EEPOM
)
2507 priv
->EEPROMPwDiff
= (eprom_read(dev
, (EEPROM_PwDiff
>> 1)) & 0x0f00) >> 8;
2509 priv
->EEPROMPwDiff
= EEPROM_Default_PwDiff
;
2510 RT_TRACE(COMP_EPROM
, "TxPwDiff:%d\n", priv
->EEPROMPwDiff
);
2511 /* Read CrystalCap from EEPROM */
2512 if (bLoad_From_EEPOM
)
2513 priv
->EEPROMCrystalCap
= (eprom_read(dev
, (EEPROM_CrystalCap
>> 1)) & 0x0f);
2515 priv
->EEPROMCrystalCap
= EEPROM_Default_CrystalCap
;
2516 RT_TRACE(COMP_EPROM
, "CrystalCap = %d\n", priv
->EEPROMCrystalCap
);
2517 /* get per-channel Tx power level */
2518 if (bLoad_From_EEPOM
)
2519 priv
->EEPROM_Def_Ver
= (eprom_read(dev
, (EEPROM_TxPwIndex_Ver
>> 1)) & 0xff00) >> 8;
2521 priv
->EEPROM_Def_Ver
= 1;
2522 RT_TRACE(COMP_EPROM
, "EEPROM_DEF_VER:%d\n", priv
->EEPROM_Def_Ver
);
2523 if (priv
->EEPROM_Def_Ver
== 0) { /* old eeprom definition */
2526 if (bLoad_From_EEPOM
)
2527 priv
->EEPROMTxPowerLevelCCK
= (eprom_read(dev
, (EEPROM_TxPwIndex_CCK
>> 1)) & 0xff) >> 8;
2529 priv
->EEPROMTxPowerLevelCCK
= 0x10;
2530 RT_TRACE(COMP_EPROM
, "CCK Tx Power Levl: 0x%02x\n", priv
->EEPROMTxPowerLevelCCK
);
2531 for (i
= 0; i
< 3; i
++) {
2532 if (bLoad_From_EEPOM
) {
2533 tmpValue
= eprom_read(dev
, (EEPROM_TxPwIndex_OFDM_24G
+ i
) >> 1);
2534 if (((EEPROM_TxPwIndex_OFDM_24G
+ i
) % 2) == 0)
2535 tmpValue
= tmpValue
& 0x00ff;
2537 tmpValue
= (tmpValue
& 0xff00) >> 8;
2541 priv
->EEPROMTxPowerLevelOFDM24G
[i
] = (u8
)tmpValue
;
2542 RT_TRACE(COMP_EPROM
, "OFDM 2.4G Tx Power Level, Index %d = 0x%02x\n", i
, priv
->EEPROMTxPowerLevelCCK
);
2544 } else if (priv
->EEPROM_Def_Ver
== 1) {
2545 if (bLoad_From_EEPOM
) {
2546 tmpValue
= eprom_read(dev
,
2547 EEPROM_TxPwIndex_CCK_V1
>> 1);
2548 tmpValue
= (tmpValue
& 0xff00) >> 8;
2552 priv
->EEPROMTxPowerLevelCCK_V1
[0] = (u8
)tmpValue
;
2554 if (bLoad_From_EEPOM
)
2555 tmpValue
= eprom_read(dev
, (EEPROM_TxPwIndex_CCK_V1
+ 2) >> 1);
2558 *((u16
*)(&priv
->EEPROMTxPowerLevelCCK_V1
[1])) = tmpValue
;
2559 if (bLoad_From_EEPOM
)
2560 tmpValue
= eprom_read(dev
,
2561 EEPROM_TxPwIndex_OFDM_24G_V1
>> 1);
2564 *((u16
*)(&priv
->EEPROMTxPowerLevelOFDM24G
[0])) = tmpValue
;
2565 if (bLoad_From_EEPOM
)
2566 tmpValue
= eprom_read(dev
, (EEPROM_TxPwIndex_OFDM_24G_V1
+ 2) >> 1);
2569 priv
->EEPROMTxPowerLevelOFDM24G
[2] = (u8
)tmpValue
;
2570 } /* endif EEPROM_Def_Ver == 1 */
2572 /* update HAL variables */
2573 for (i
= 0; i
< 14; i
++) {
2575 priv
->TxPowerLevelOFDM24G
[i
] = priv
->EEPROMTxPowerLevelOFDM24G
[0];
2576 else if (i
>= 4 && i
<= 9)
2577 priv
->TxPowerLevelOFDM24G
[i
] = priv
->EEPROMTxPowerLevelOFDM24G
[1];
2579 priv
->TxPowerLevelOFDM24G
[i
] = priv
->EEPROMTxPowerLevelOFDM24G
[2];
2582 for (i
= 0; i
< 14; i
++) {
2583 if (priv
->EEPROM_Def_Ver
== 0) {
2585 priv
->TxPowerLevelCCK
[i
] = priv
->EEPROMTxPowerLevelOFDM24G
[0] + (priv
->EEPROMTxPowerLevelCCK
- priv
->EEPROMTxPowerLevelOFDM24G
[1]);
2586 else if (i
>= 4 && i
<= 9)
2587 priv
->TxPowerLevelCCK
[i
] = priv
->EEPROMTxPowerLevelCCK
;
2589 priv
->TxPowerLevelCCK
[i
] = priv
->EEPROMTxPowerLevelOFDM24G
[2] + (priv
->EEPROMTxPowerLevelCCK
- priv
->EEPROMTxPowerLevelOFDM24G
[1]);
2590 } else if (priv
->EEPROM_Def_Ver
== 1) {
2592 priv
->TxPowerLevelCCK
[i
] = priv
->EEPROMTxPowerLevelCCK_V1
[0];
2593 else if (i
>= 4 && i
<= 9)
2594 priv
->TxPowerLevelCCK
[i
] = priv
->EEPROMTxPowerLevelCCK_V1
[1];
2596 priv
->TxPowerLevelCCK
[i
] = priv
->EEPROMTxPowerLevelCCK_V1
[2];
2599 priv
->TxPowerDiff
= priv
->EEPROMPwDiff
;
2600 /* Antenna B gain offset to antenna A, bit0~3 */
2601 priv
->AntennaTxPwDiff
[0] = (priv
->EEPROMTxPowerDiff
& 0xf);
2602 /* Antenna C gain offset to antenna A, bit4~7 */
2603 priv
->AntennaTxPwDiff
[1] =
2604 (priv
->EEPROMTxPowerDiff
& 0xf0) >> 4;
2605 /* CrystalCap, bit12~15 */
2606 priv
->CrystalCap
= priv
->EEPROMCrystalCap
;
2607 /* ThermalMeter, bit0~3 for RFIC1, bit4~7 for RFIC2
2608 * 92U does not enable TX power tracking.
2610 priv
->ThermalMeter
[0] = priv
->EEPROMThermalMeter
;
2611 } /* end if VersionID == VERSION_819xU_A */
2614 switch (priv
->eeprom_CustomerID
) {
2615 case EEPROM_CID_RUNTOP
:
2616 priv
->CustomerID
= RT_CID_819x_RUNTOP
;
2619 case EEPROM_CID_DLINK
:
2620 priv
->CustomerID
= RT_CID_DLINK
;
2624 priv
->CustomerID
= RT_CID_DEFAULT
;
2629 switch (priv
->CustomerID
) {
2630 case RT_CID_819x_RUNTOP
:
2631 priv
->LedStrategy
= SW_LED_MODE2
;
2635 priv
->LedStrategy
= SW_LED_MODE4
;
2639 priv
->LedStrategy
= SW_LED_MODE0
;
2645 if (priv
->rf_type
== RF_1T2R
)
2646 RT_TRACE(COMP_EPROM
, "\n1T2R config\n");
2648 RT_TRACE(COMP_EPROM
, "\n2T4R config\n");
2650 /* We can only know RF type in the function. So we have to init
2651 * DIG RATR table again.
2653 init_rate_adaptive(dev
);
2655 RT_TRACE(COMP_EPROM
, "<===========%s()\n", __func__
);
2658 static short rtl8192_get_channel_map(struct net_device
*dev
)
2660 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2662 if (priv
->ChannelPlan
> COUNTRY_CODE_GLOBAL_DOMAIN
) {
2664 "rtl8180_init: Error channel plan! Set to default.\n");
2665 priv
->ChannelPlan
= 0;
2667 RT_TRACE(COMP_INIT
, "Channel plan is %d\n", priv
->ChannelPlan
);
2669 rtl819x_set_channel_map(priv
->ChannelPlan
, priv
);
2673 static short rtl8192_init(struct net_device
*dev
)
2676 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2678 memset(&(priv
->stats
), 0, sizeof(struct Stats
));
2679 memset(priv
->txqueue_to_outpipemap
, 0, 9);
2683 u8 queuetopipe
[] = {3, 2, 1, 0, 4, 8, 7, 6, 5};
2685 memcpy(priv
->txqueue_to_outpipemap
, queuetopipe
, 9);
2689 u8 queuetopipe
[] = {3, 2, 1, 0, 4, 4, 0, 4, 4};
2691 memcpy(priv
->txqueue_to_outpipemap
, queuetopipe
, 9);
2694 rtl8192_init_priv_variable(dev
);
2695 rtl8192_init_priv_lock(priv
);
2696 rtl8192_init_priv_task(dev
);
2697 rtl8192_get_eeprom_size(dev
);
2698 rtl8192_read_eeprom_info(dev
);
2699 rtl8192_get_channel_map(dev
);
2701 setup_timer(&priv
->watch_dog_timer
, watch_dog_timer_callback
,
2702 (unsigned long)dev
);
2703 if (rtl8192_usb_initendpoints(dev
) != 0) {
2704 DMESG("Endopoints initialization failed");
2711 /******************************************************************************
2712 *function: This function actually only set RRSR, RATR and BW_OPMODE registers
2713 * not to do all the hw config as its name says
2714 * input: net_device dev
2717 * notice: This part need to modified according to the rate set we filtered
2718 * ****************************************************************************/
2719 static void rtl8192_hwconfig(struct net_device
*dev
)
2721 u32 regRATR
= 0, regRRSR
= 0;
2722 u8 regBwOpMode
= 0, regTmp
= 0;
2723 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2726 /* Set RRSR, RATR, and BW_OPMODE registers */
2727 switch (priv
->ieee80211
->mode
) {
2728 case WIRELESS_MODE_B
:
2729 regBwOpMode
= BW_OPMODE_20MHZ
;
2730 regRATR
= RATE_ALL_CCK
;
2731 regRRSR
= RATE_ALL_CCK
;
2733 case WIRELESS_MODE_A
:
2734 regBwOpMode
= BW_OPMODE_5G
| BW_OPMODE_20MHZ
;
2735 regRATR
= RATE_ALL_OFDM_AG
;
2736 regRRSR
= RATE_ALL_OFDM_AG
;
2738 case WIRELESS_MODE_G
:
2739 regBwOpMode
= BW_OPMODE_20MHZ
;
2740 regRATR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
;
2741 regRRSR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
;
2743 case WIRELESS_MODE_AUTO
:
2745 if (Adapter
->bInHctTest
) {
2746 regBwOpMode
= BW_OPMODE_20MHZ
;
2747 regRATR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
;
2748 regRRSR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
;
2752 regBwOpMode
= BW_OPMODE_20MHZ
;
2753 regRATR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
|
2754 RATE_ALL_OFDM_1SS
| RATE_ALL_OFDM_2SS
;
2755 regRRSR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
;
2758 case WIRELESS_MODE_N_24G
:
2759 /* It support CCK rate by default. CCK rate will be filtered
2760 * out only when associated AP does not support it.
2762 regBwOpMode
= BW_OPMODE_20MHZ
;
2763 regRATR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
|
2764 RATE_ALL_OFDM_1SS
| RATE_ALL_OFDM_2SS
;
2765 regRRSR
= RATE_ALL_CCK
| RATE_ALL_OFDM_AG
;
2767 case WIRELESS_MODE_N_5G
:
2768 regBwOpMode
= BW_OPMODE_5G
;
2769 regRATR
= RATE_ALL_OFDM_AG
| RATE_ALL_OFDM_1SS
|
2771 regRRSR
= RATE_ALL_OFDM_AG
;
2775 write_nic_byte(dev
, BW_OPMODE
, regBwOpMode
);
2776 ratr_value
= regRATR
;
2777 if (priv
->rf_type
== RF_1T2R
)
2778 ratr_value
&= ~(RATE_ALL_OFDM_2SS
);
2779 write_nic_dword(dev
, RATR0
, ratr_value
);
2780 write_nic_byte(dev
, UFWP
, 1);
2781 read_nic_byte(dev
, 0x313, ®Tmp
);
2782 regRRSR
= ((regTmp
) << 24) | (regRRSR
& 0x00ffffff);
2783 write_nic_dword(dev
, RRSR
, regRRSR
);
2785 /* Set Retry Limit here */
2786 write_nic_word(dev
, RETRY_LIMIT
,
2787 priv
->ShortRetryLimit
<< RETRY_LIMIT_SHORT_SHIFT
|
2788 priv
->LongRetryLimit
<< RETRY_LIMIT_LONG_SHIFT
);
2789 /* Set Contention Window here */
2793 /* Set Tx Antenna including Feedback control */
2795 /* Set Auto Rate fallback control */
2801 /* InitializeAdapter and PhyCfg */
2802 static bool rtl8192_adapter_start(struct net_device
*dev
)
2804 struct r8192_priv
*priv
= ieee80211_priv(dev
);
2806 bool init_status
= true;
2807 u8 SECR_value
= 0x0;
2810 RT_TRACE(COMP_INIT
, "====>%s()\n", __func__
);
2811 priv
->Rf_Mode
= RF_OP_By_SW_3wire
;
2812 /* for ASIC power on sequence */
2813 write_nic_byte_E(dev
, 0x5f, 0x80);
2815 write_nic_byte_E(dev
, 0x5f, 0xf0);
2816 write_nic_byte_E(dev
, 0x5d, 0x00);
2817 write_nic_byte_E(dev
, 0x5e, 0x80);
2818 write_nic_byte(dev
, 0x17, 0x37);
2820 priv
->pFirmware
->firmware_status
= FW_STATUS_0_INIT
;
2821 /* config CPUReset Register */
2822 /* Firmware Reset or not? */
2823 read_nic_dword(dev
, CPU_GEN
, &dwRegRead
);
2824 if (priv
->pFirmware
->firmware_status
== FW_STATUS_0_INIT
)
2825 dwRegRead
|= CPU_GEN_SYSTEM_RESET
; /* do nothing here? */
2826 else if (priv
->pFirmware
->firmware_status
== FW_STATUS_5_READY
)
2827 dwRegRead
|= CPU_GEN_FIRMWARE_RESET
;
2830 "ERROR in %s(): undefined firmware state(%d)\n",
2831 __func__
, priv
->pFirmware
->firmware_status
);
2833 write_nic_dword(dev
, CPU_GEN
, dwRegRead
);
2835 rtl8192_BBConfig(dev
);
2837 /* Loopback mode or not */
2838 priv
->LoopbackMode
= RTL819xU_NO_LOOPBACK
;
2840 read_nic_dword(dev
, CPU_GEN
, &dwRegRead
);
2841 if (priv
->LoopbackMode
== RTL819xU_NO_LOOPBACK
)
2842 dwRegRead
= (dwRegRead
& CPU_GEN_NO_LOOPBACK_MSK
) |
2843 CPU_GEN_NO_LOOPBACK_SET
;
2844 else if (priv
->LoopbackMode
== RTL819xU_MAC_LOOPBACK
)
2845 dwRegRead
|= CPU_CCK_LOOPBACK
;
2848 "Serious error in %s(): wrong loopback mode setting(%d)\n",
2849 __func__
, priv
->LoopbackMode
);
2851 write_nic_dword(dev
, CPU_GEN
, dwRegRead
);
2853 /* after reset cpu, we need wait for a seconds to write in register. */
2856 /* add for new bitfile:usb suspend reset pin set to 1. Do we need? */
2857 read_nic_byte_E(dev
, 0x5f, &tmp
);
2858 write_nic_byte_E(dev
, 0x5f, tmp
| 0x20);
2861 rtl8192_hwconfig(dev
);
2864 write_nic_byte(dev
, CMDR
, CR_RE
| CR_TE
);
2867 write_nic_dword(dev
, MAC0
, ((u32
*)dev
->dev_addr
)[0]);
2868 write_nic_word(dev
, MAC4
, ((u16
*)(dev
->dev_addr
+ 4))[0]);
2871 write_nic_dword(dev
, RCR
, priv
->ReceiveConfig
);
2873 /* Initialize Number of Reserved Pages in Firmware Queue */
2874 write_nic_dword(dev
, RQPN1
,
2875 NUM_OF_PAGE_IN_FW_QUEUE_BK
<< RSVD_FW_QUEUE_PAGE_BK_SHIFT
|
2876 NUM_OF_PAGE_IN_FW_QUEUE_BE
<< RSVD_FW_QUEUE_PAGE_BE_SHIFT
|
2877 NUM_OF_PAGE_IN_FW_QUEUE_VI
<< RSVD_FW_QUEUE_PAGE_VI_SHIFT
|
2878 NUM_OF_PAGE_IN_FW_QUEUE_VO
<< RSVD_FW_QUEUE_PAGE_VO_SHIFT
);
2879 write_nic_dword(dev
, RQPN2
,
2880 NUM_OF_PAGE_IN_FW_QUEUE_MGNT
<< RSVD_FW_QUEUE_PAGE_MGNT_SHIFT
|
2881 NUM_OF_PAGE_IN_FW_QUEUE_CMD
<< RSVD_FW_QUEUE_PAGE_CMD_SHIFT
);
2882 write_nic_dword(dev
, RQPN3
,
2883 APPLIED_RESERVED_QUEUE_IN_FW
|
2884 NUM_OF_PAGE_IN_FW_QUEUE_BCN
<< RSVD_FW_QUEUE_PAGE_BCN_SHIFT
);
2885 write_nic_dword(dev
, RATR0
+ 4 * 7, (RATE_ALL_OFDM_AG
| RATE_ALL_CCK
));
2887 /* Set AckTimeout */
2888 /* TODO: (it value is only for FPGA version). need to be changed!! */
2889 write_nic_byte(dev
, ACK_TIMEOUT
, 0x30);
2891 if (priv
->ResetProgress
== RESET_TYPE_NORESET
)
2892 rtl8192_SetWirelessMode(dev
, priv
->ieee80211
->mode
);
2893 if (priv
->ResetProgress
== RESET_TYPE_NORESET
) {
2894 CamResetAllEntry(dev
);
2895 SECR_value
|= SCR_TxEncEnable
;
2896 SECR_value
|= SCR_RxDecEnable
;
2897 SECR_value
|= SCR_NoSKMC
;
2898 write_nic_byte(dev
, SECR
, SECR_value
);
2901 /* Beacon related */
2902 write_nic_word(dev
, ATIMWND
, 2);
2903 write_nic_word(dev
, BCN_INTERVAL
, 100);
2905 #define DEFAULT_EDCA 0x005e4332
2909 for (i
= 0; i
< QOS_QUEUE_NUM
; i
++)
2910 write_nic_dword(dev
, WDCAPARA_ADD
[i
], DEFAULT_EDCA
);
2913 rtl8192_phy_configmac(dev
);
2915 if (priv
->card_8192_version
== (u8
)VERSION_819xU_A
) {
2916 rtl8192_phy_getTxPower(dev
);
2917 rtl8192_phy_setTxPower(dev
, priv
->chan
);
2920 /* Firmware download */
2921 init_status
= init_firmware(dev
);
2923 RT_TRACE(COMP_ERR
, "ERR!!! %s(): Firmware download is failed\n",
2927 RT_TRACE(COMP_INIT
, "%s():after firmware download\n", __func__
);
2930 if (Adapter
->ResetProgress
== RESET_TYPE_NORESET
) {
2931 if (pMgntInfo
->RegRfOff
) { /* User disable RF via registry. */
2932 RT_TRACE((COMP_INIT
| COMP_RF
), DBG_LOUD
,
2933 ("InitializeAdapter819xUsb(): Turn off RF for RegRfOff ----------\n"));
2934 MgntActSet_RF_State(Adapter
, eRfOff
, RF_CHANGE_BY_SW
);
2935 /* Those actions will be discard in MgntActSet_RF_State
2936 * because of the same state
2938 for (eRFPath
= 0; eRFPath
< pHalData
->NumTotalRFPath
; eRFPath
++)
2939 PHY_SetRFReg(Adapter
,
2940 (RF90_RADIO_PATH_E
)eRFPath
,
2942 } else if (pMgntInfo
->RfOffReason
> RF_CHANGE_BY_PS
) {
2943 /* H/W or S/W RF OFF before sleep. */
2944 RT_TRACE((COMP_INIT
| COMP_RF
), DBG_LOUD
,
2945 ("InitializeAdapter819xUsb(): Turn off RF for RfOffReason(%d) ----------\n",
2946 pMgntInfo
->RfOffReason
));
2947 MgntActSet_RF_State(Adapter
,
2949 pMgntInfo
->RfOffReason
);
2951 pHalData
->eRFPowerState
= eRfOn
;
2952 pMgntInfo
->RfOffReason
= 0;
2953 RT_TRACE((COMP_INIT
| COMP_RF
), DBG_LOUD
,
2954 ("InitializeAdapter819xUsb(): RF is on ----------\n"));
2957 if (pHalData
->eRFPowerState
== eRfOff
) {
2958 MgntActSet_RF_State(Adapter
,
2960 pMgntInfo
->RfOffReason
);
2961 /* Those actions will be discard in MgntActSet_RF_State
2962 * because of the same state
2964 for (eRFPath
= 0; eRFPath
< pHalData
->NumTotalRFPath
; eRFPath
++)
2965 PHY_SetRFReg(Adapter
,
2966 (RF90_RADIO_PATH_E
)eRFPath
,
2972 if (priv
->ResetProgress
== RESET_TYPE_NORESET
) {
2973 rtl8192_phy_RFConfig(dev
);
2974 RT_TRACE(COMP_INIT
, "%s():after phy RF config\n", __func__
);
2978 if (priv
->ieee80211
->FwRWRF
)
2979 /* We can force firmware to do RF-R/W */
2980 priv
->Rf_Mode
= RF_OP_By_FW
;
2982 priv
->Rf_Mode
= RF_OP_By_SW_3wire
;
2985 rtl8192_phy_updateInitGain(dev
);
2986 /*--set CCK and OFDM Block "ON"--*/
2987 rtl8192_setBBreg(dev
, rFPGA0_RFMOD
, bCCKEn
, 0x1);
2988 rtl8192_setBBreg(dev
, rFPGA0_RFMOD
, bOFDMEn
, 0x1);
2990 if (priv
->ResetProgress
== RESET_TYPE_NORESET
) {
2994 read_nic_byte(dev
, 0x301, &tmpvalue
);
2995 if (tmpvalue
== 0x03) {
2997 RT_TRACE(COMP_POWER_TRACKING
, "D-cut\n");
2999 priv
->bDcut
= false;
3000 RT_TRACE(COMP_POWER_TRACKING
, "C-cut\n");
3002 dm_initialize_txpower_tracking(dev
);
3006 u32 tmpRegA
= rtl8192_QueryBBReg(dev
,
3007 rOFDM0_XATxIQImbalance
,
3010 for (i
= 0; i
< TxBBGainTableLength
; i
++) {
3011 if (tmpRegA
== priv
->txbbgain_table
[i
].txbbgain_value
) {
3012 priv
->rfa_txpowertrackingindex
= (u8
)i
;
3013 priv
->rfa_txpowertrackingindex_real
=
3015 priv
->rfa_txpowertracking_default
=
3016 priv
->rfa_txpowertrackingindex
;
3021 TempCCk
= rtl8192_QueryBBReg(dev
,
3025 for (i
= 0; i
< CCKTxBBGainTableLength
; i
++) {
3027 if (TempCCk
== priv
->cck_txbbgain_table
[i
].ccktxbb_valuearray
[0]) {
3028 priv
->cck_present_attentuation_20Mdefault
= (u8
)i
;
3032 priv
->cck_present_attentuation_40Mdefault
= 0;
3033 priv
->cck_present_attentuation_difference
= 0;
3034 priv
->cck_present_attentuation
=
3035 priv
->cck_present_attentuation_20Mdefault
;
3039 write_nic_byte(dev
, 0x87, 0x0);
3045 /* this configures registers for beacon tx and enables it via
3046 * rtl8192_beacon_tx_enable(). rtl8192_beacon_tx_disable() might
3047 * be used to stop beacon transmission
3049 /***************************************************************************
3050 -------------------------------NET STUFF---------------------------
3051 ***************************************************************************/
3053 static struct net_device_stats
*rtl8192_stats(struct net_device
*dev
)
3055 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3057 return &priv
->ieee80211
->stats
;
3060 static bool HalTxCheckStuck819xUsb(struct net_device
*dev
)
3062 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3064 bool bStuck
= false;
3066 read_nic_word(dev
, 0x128, &RegTxCounter
);
3067 RT_TRACE(COMP_RESET
,
3068 "%s():RegTxCounter is %d,TxCounter is %d\n", __func__
,
3069 RegTxCounter
, priv
->TxCounter
);
3070 if (priv
->TxCounter
== RegTxCounter
)
3073 priv
->TxCounter
= RegTxCounter
;
3079 * <Assumption: RT_TX_SPINLOCK is acquired.>
3080 * First added: 2006.11.19 by emily
3082 static RESET_TYPE
TxCheckStuck(struct net_device
*dev
)
3084 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3086 bool bCheckFwTxCnt
= false;
3088 /* Decide such threshold according to current power save mode */
3090 for (QueueID
= 0; QueueID
<= BEACON_QUEUE
; QueueID
++) {
3091 if (QueueID
== TXCMD_QUEUE
)
3093 if ((skb_queue_len(&priv
->ieee80211
->skb_waitQ
[QueueID
]) == 0) && (skb_queue_len(&priv
->ieee80211
->skb_aggQ
[QueueID
]) == 0))
3096 bCheckFwTxCnt
= true;
3098 if (bCheckFwTxCnt
) {
3099 if (HalTxCheckStuck819xUsb(dev
)) {
3100 RT_TRACE(COMP_RESET
,
3101 "TxCheckStuck(): Fw indicates no Tx condition!\n");
3102 return RESET_TYPE_SILENT
;
3105 return RESET_TYPE_NORESET
;
3108 static bool HalRxCheckStuck819xUsb(struct net_device
*dev
)
3111 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3112 bool bStuck
= false;
3113 static u8 rx_chk_cnt
;
3115 read_nic_word(dev
, 0x130, &RegRxCounter
);
3116 RT_TRACE(COMP_RESET
,
3117 "%s(): RegRxCounter is %d,RxCounter is %d\n", __func__
,
3118 RegRxCounter
, priv
->RxCounter
);
3119 /* If rssi is small, we should check rx for long time because of bad rx.
3120 * or maybe it will continuous silent reset every 2 seconds.
3123 if (priv
->undecorated_smoothed_pwdb
>= (RateAdaptiveTH_High
+ 5)) {
3124 rx_chk_cnt
= 0; /* high rssi, check rx stuck right now. */
3125 } else if (priv
->undecorated_smoothed_pwdb
< (RateAdaptiveTH_High
+ 5) &&
3126 ((priv
->CurrentChannelBW
!= HT_CHANNEL_WIDTH_20
&& priv
->undecorated_smoothed_pwdb
>= RateAdaptiveTH_Low_40M
) ||
3127 (priv
->CurrentChannelBW
== HT_CHANNEL_WIDTH_20
&& priv
->undecorated_smoothed_pwdb
>= RateAdaptiveTH_Low_20M
))) {
3132 } else if (((priv
->CurrentChannelBW
!= HT_CHANNEL_WIDTH_20
&& priv
->undecorated_smoothed_pwdb
< RateAdaptiveTH_Low_40M
) ||
3133 (priv
->CurrentChannelBW
== HT_CHANNEL_WIDTH_20
&& priv
->undecorated_smoothed_pwdb
< RateAdaptiveTH_Low_20M
)) &&
3134 priv
->undecorated_smoothed_pwdb
>= VeryLowRSSI
) {
3146 if (priv
->RxCounter
== RegRxCounter
)
3149 priv
->RxCounter
= RegRxCounter
;
3154 static RESET_TYPE
RxCheckStuck(struct net_device
*dev
)
3156 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3157 bool bRxCheck
= false;
3159 if (priv
->IrpPendingCount
> 1)
3163 if (HalRxCheckStuck819xUsb(dev
)) {
3164 RT_TRACE(COMP_RESET
, "RxStuck Condition\n");
3165 return RESET_TYPE_SILENT
;
3168 return RESET_TYPE_NORESET
;
3173 * This function is called by Checkforhang to check whether we should
3174 * ask OS to reset driver
3176 * \param pAdapter The adapter context for this miniport
3178 * Note:NIC with USB interface sholud not call this function because we
3179 * cannot scan descriptor to judge whether there is tx stuck.
3180 * Note: This function may be required to be rewrite for Vista OS.
3181 * <<<Assumption: Tx spinlock has been acquired >>>
3183 * 8185 and 8185b does not implement this function.
3185 static RESET_TYPE
rtl819x_ifcheck_resetornot(struct net_device
*dev
)
3187 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3188 RESET_TYPE TxResetType
= RESET_TYPE_NORESET
;
3189 RESET_TYPE RxResetType
= RESET_TYPE_NORESET
;
3190 RT_RF_POWER_STATE rfState
;
3192 rfState
= priv
->ieee80211
->eRFPowerState
;
3194 TxResetType
= TxCheckStuck(dev
);
3195 if (rfState
!= eRfOff
||
3196 (priv
->ieee80211
->iw_mode
!= IW_MODE_ADHOC
)) {
3197 /* If driver is in the status of firmware download failure,
3198 * driver skips RF initialization and RF is in turned off
3199 * state. Driver should check whether Rx stuck and do silent
3200 * reset. And if driver is in firmware download failure status,
3201 * driver should initialize RF in the following silent reset
3204 * Driver should not check RX stuck in IBSS mode because it is
3205 * required to set Check BSSID in order to send beacon,
3206 * however, if check BSSID is set, STA cannot hear any packet
3209 RxResetType
= RxCheckStuck(dev
);
3211 if (TxResetType
== RESET_TYPE_NORMAL
||
3212 RxResetType
== RESET_TYPE_NORMAL
) {
3213 return RESET_TYPE_NORMAL
;
3214 } else if (TxResetType
== RESET_TYPE_SILENT
||
3215 RxResetType
== RESET_TYPE_SILENT
) {
3216 RT_TRACE(COMP_RESET
, "%s():silent reset\n", __func__
);
3217 return RESET_TYPE_SILENT
;
3219 return RESET_TYPE_NORESET
;
3224 static void rtl8192_cancel_deferred_work(struct r8192_priv
*priv
);
3225 static int _rtl8192_up(struct net_device
*dev
);
3226 static int rtl8192_close(struct net_device
*dev
);
3230 static void CamRestoreAllEntry(struct net_device
*dev
)
3233 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3234 u8
*MacAddr
= priv
->ieee80211
->current_network
.bssid
;
3236 static u8 CAM_CONST_ADDR
[4][6] = {
3237 {0x00, 0x00, 0x00, 0x00, 0x00, 0x00},
3238 {0x00, 0x00, 0x00, 0x00, 0x00, 0x01},
3239 {0x00, 0x00, 0x00, 0x00, 0x00, 0x02},
3240 {0x00, 0x00, 0x00, 0x00, 0x00, 0x03} };
3241 static u8 CAM_CONST_BROAD
[] = {
3242 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
3244 RT_TRACE(COMP_SEC
, "CamRestoreAllEntry:\n");
3247 if ((priv
->ieee80211
->pairwise_key_type
== KEY_TYPE_WEP40
) ||
3248 (priv
->ieee80211
->pairwise_key_type
== KEY_TYPE_WEP104
)) {
3250 for (EntryId
= 0; EntryId
< 4; EntryId
++) {
3251 MacAddr
= CAM_CONST_ADDR
[EntryId
];
3252 setKey(dev
, EntryId
, EntryId
,
3253 priv
->ieee80211
->pairwise_key_type
,
3257 } else if (priv
->ieee80211
->pairwise_key_type
== KEY_TYPE_TKIP
) {
3259 if (priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
)
3260 setKey(dev
, 4, 0, priv
->ieee80211
->pairwise_key_type
,
3261 (u8
*)dev
->dev_addr
, 0, NULL
);
3263 setKey(dev
, 4, 0, priv
->ieee80211
->pairwise_key_type
,
3265 } else if (priv
->ieee80211
->pairwise_key_type
== KEY_TYPE_CCMP
) {
3267 if (priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
)
3268 setKey(dev
, 4, 0, priv
->ieee80211
->pairwise_key_type
,
3269 (u8
*)dev
->dev_addr
, 0, NULL
);
3271 setKey(dev
, 4, 0, priv
->ieee80211
->pairwise_key_type
,
3277 if (priv
->ieee80211
->group_key_type
== KEY_TYPE_TKIP
) {
3278 MacAddr
= CAM_CONST_BROAD
;
3279 for (EntryId
= 1; EntryId
< 4; EntryId
++) {
3280 setKey(dev
, EntryId
, EntryId
,
3281 priv
->ieee80211
->group_key_type
,
3284 if (priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
)
3285 setKey(dev
, 0, 0, priv
->ieee80211
->group_key_type
,
3286 CAM_CONST_ADDR
[0], 0, NULL
);
3287 } else if (priv
->ieee80211
->group_key_type
== KEY_TYPE_CCMP
) {
3288 MacAddr
= CAM_CONST_BROAD
;
3289 for (EntryId
= 1; EntryId
< 4; EntryId
++) {
3290 setKey(dev
, EntryId
, EntryId
,
3291 priv
->ieee80211
->group_key_type
,
3295 if (priv
->ieee80211
->iw_mode
== IW_MODE_ADHOC
)
3296 setKey(dev
, 0, 0, priv
->ieee80211
->group_key_type
,
3297 CAM_CONST_ADDR
[0], 0, NULL
);
3300 /* This function is used to fix Tx/Rx stop bug temporarily.
3301 * This function will do "system reset" to NIC when Tx or Rx is stuck.
3302 * The method checking Tx/Rx stuck of this function is supported by FW,
3303 * which reports Tx and Rx counter to register 0x128 and 0x130.
3305 static void rtl819x_ifsilentreset(struct net_device
*dev
)
3307 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3309 int reset_status
= 0;
3310 struct ieee80211_device
*ieee
= priv
->ieee80211
;
3313 /* If we need to check CCK stop, please uncomment this line. */
3314 /* bStuck = Adapter->HalFunc.CheckHWStopHandler(Adapter); */
3316 if (priv
->ResetProgress
== RESET_TYPE_NORESET
) {
3319 RT_TRACE(COMP_RESET
, "=========>Reset progress!!\n");
3321 /* Set the variable for reset. */
3322 priv
->ResetProgress
= RESET_TYPE_SILENT
;
3323 down(&priv
->wx_sem
);
3324 if (priv
->up
== 0) {
3326 "%s():the driver is not up! return\n",
3332 RT_TRACE(COMP_RESET
,
3333 "%s():======>start to down the driver\n",
3336 rtl8192_rtx_disable(dev
);
3337 rtl8192_cancel_deferred_work(priv
);
3339 del_timer_sync(&priv
->watch_dog_timer
);
3341 ieee
->sync_scan_hurryup
= 1;
3342 if (ieee
->state
== IEEE80211_LINKED
) {
3343 down(&ieee
->wx_sem
);
3344 netdev_dbg(dev
, "ieee->state is IEEE80211_LINKED\n");
3345 ieee80211_stop_send_beacons(priv
->ieee80211
);
3346 del_timer_sync(&ieee
->associate_timer
);
3347 cancel_delayed_work(&ieee
->associate_retry_wq
);
3348 ieee80211_stop_scan(ieee
);
3349 netif_carrier_off(dev
);
3352 netdev_dbg(dev
, "ieee->state is NOT LINKED\n");
3353 ieee80211_softmac_stop_protocol(priv
->ieee80211
);
3356 RT_TRACE(COMP_RESET
,
3357 "%s():<==========down process is finished\n",
3359 RT_TRACE(COMP_RESET
,
3360 "%s():===========>start up the driver\n",
3362 reset_status
= _rtl8192_up(dev
);
3364 RT_TRACE(COMP_RESET
,
3365 "%s():<===========up process is finished\n",
3367 if (reset_status
== -EAGAIN
) {
3368 if (reset_times
< 3) {
3373 " ERR!!! %s(): Reset Failed!!\n",
3377 ieee
->is_silent_reset
= 1;
3378 EnableHWSecurityConfig8192(dev
);
3379 if (ieee
->state
== IEEE80211_LINKED
&&
3380 ieee
->iw_mode
== IW_MODE_INFRA
) {
3381 ieee
->set_chan(ieee
->dev
,
3382 ieee
->current_network
.channel
);
3384 queue_work(ieee
->wq
, &ieee
->associate_complete_wq
);
3386 } else if (ieee
->state
== IEEE80211_LINKED
&&
3387 ieee
->iw_mode
== IW_MODE_ADHOC
) {
3388 ieee
->set_chan(ieee
->dev
,
3389 ieee
->current_network
.channel
);
3390 ieee
->link_change(ieee
->dev
);
3392 ieee80211_start_send_beacons(ieee
);
3394 if (ieee
->data_hard_resume
)
3395 ieee
->data_hard_resume(ieee
->dev
);
3396 netif_carrier_on(ieee
->dev
);
3399 CamRestoreAllEntry(dev
);
3401 priv
->ResetProgress
= RESET_TYPE_NORESET
;
3402 priv
->reset_count
++;
3404 priv
->bForcedSilentReset
= false;
3405 priv
->bResetInProgress
= false;
3407 /* For test --> force write UFWP. */
3408 write_nic_byte(dev
, UFWP
, 1);
3409 RT_TRACE(COMP_RESET
,
3410 "Reset finished!! ====>[%d]\n",
3415 static void rtl819x_update_rxcounts(struct r8192_priv
*priv
, u32
*TotalRxBcnNum
,
3416 u32
*TotalRxDataNum
)
3422 *TotalRxDataNum
= 0;
3424 SlotIndex
= (priv
->ieee80211
->LinkDetectInfo
.SlotIndex
++) %
3425 (priv
->ieee80211
->LinkDetectInfo
.SlotNum
);
3426 priv
->ieee80211
->LinkDetectInfo
.RxBcnNum
[SlotIndex
] =
3427 priv
->ieee80211
->LinkDetectInfo
.NumRecvBcnInPeriod
;
3428 priv
->ieee80211
->LinkDetectInfo
.RxDataNum
[SlotIndex
] =
3429 priv
->ieee80211
->LinkDetectInfo
.NumRecvDataInPeriod
;
3430 for (i
= 0; i
< priv
->ieee80211
->LinkDetectInfo
.SlotNum
; i
++) {
3431 *TotalRxBcnNum
+= priv
->ieee80211
->LinkDetectInfo
.RxBcnNum
[i
];
3432 *TotalRxDataNum
+= priv
->ieee80211
->LinkDetectInfo
.RxDataNum
[i
];
3437 static void rtl819x_watchdog_wqcallback(struct work_struct
*work
)
3439 struct delayed_work
*dwork
= container_of(work
,
3440 struct delayed_work
, work
);
3441 struct r8192_priv
*priv
= container_of(dwork
,
3442 struct r8192_priv
, watch_dog_wq
);
3443 struct net_device
*dev
= priv
->ieee80211
->dev
;
3444 struct ieee80211_device
*ieee
= priv
->ieee80211
;
3445 RESET_TYPE ResetType
= RESET_TYPE_NORESET
;
3446 static u8 check_reset_cnt
;
3447 bool bBusyTraffic
= false;
3448 u32 TotalRxBcnNum
= 0;
3449 u32 TotalRxDataNum
= 0;
3453 hal_dm_watchdog(dev
);
3455 /* to get busy traffic condition */
3456 if (ieee
->state
== IEEE80211_LINKED
) {
3457 if (ieee
->LinkDetectInfo
.NumRxOkInPeriod
> 666 ||
3458 ieee
->LinkDetectInfo
.NumTxOkInPeriod
> 666) {
3459 bBusyTraffic
= true;
3461 ieee
->LinkDetectInfo
.NumRxOkInPeriod
= 0;
3462 ieee
->LinkDetectInfo
.NumTxOkInPeriod
= 0;
3463 ieee
->LinkDetectInfo
.bBusyTraffic
= bBusyTraffic
;
3465 /* for AP roaming */
3466 if (priv
->ieee80211
->state
== IEEE80211_LINKED
&&
3467 priv
->ieee80211
->iw_mode
== IW_MODE_INFRA
) {
3469 rtl819x_update_rxcounts(priv
, &TotalRxBcnNum
, &TotalRxDataNum
);
3470 if ((TotalRxBcnNum
+ TotalRxDataNum
) == 0) {
3472 if (rfState
== eRfOff
)
3473 RT_TRACE(COMP_ERR
, "========>%s()\n", __func__
);
3476 "===>%s(): AP is power off, connect another one\n",
3478 priv
->ieee80211
->state
= IEEE80211_ASSOCIATING
;
3479 notify_wx_assoc_event(priv
->ieee80211
);
3480 RemovePeerTS(priv
->ieee80211
,
3481 priv
->ieee80211
->current_network
.bssid
);
3482 priv
->ieee80211
->link_change(dev
);
3483 queue_work(priv
->ieee80211
->wq
,
3484 &priv
->ieee80211
->associate_procedure_wq
);
3488 priv
->ieee80211
->LinkDetectInfo
.NumRecvBcnInPeriod
= 0;
3489 priv
->ieee80211
->LinkDetectInfo
.NumRecvDataInPeriod
= 0;
3490 /* check if reset the driver */
3491 if (check_reset_cnt
++ >= 3) {
3492 ResetType
= rtl819x_ifcheck_resetornot(dev
);
3493 check_reset_cnt
= 3;
3495 /* This is control by OID set in Pomelo */
3496 if ((priv
->force_reset
) || (priv
->ResetProgress
== RESET_TYPE_NORESET
&&
3497 (priv
->bForcedSilentReset
||
3498 (!priv
->bDisableNormalResetCheck
&& ResetType
== RESET_TYPE_SILENT
)))) {
3499 RT_TRACE(COMP_RESET
,
3500 "%s():priv->force_reset is %d,priv->ResetProgress is %d, priv->bForcedSilentReset is %d,priv->bDisableNormalResetCheck is %d,ResetType is %d\n",
3501 __func__
, priv
->force_reset
, priv
->ResetProgress
,
3502 priv
->bForcedSilentReset
,
3503 priv
->bDisableNormalResetCheck
, ResetType
);
3504 rtl819x_ifsilentreset(dev
);
3506 priv
->force_reset
= false;
3507 priv
->bForcedSilentReset
= false;
3508 priv
->bResetInProgress
= false;
3509 RT_TRACE(COMP_TRACE
, " <==RtUsbCheckForHangWorkItemCallback()\n");
3513 static void watch_dog_timer_callback(unsigned long data
)
3515 struct r8192_priv
*priv
= ieee80211_priv((struct net_device
*)data
);
3517 queue_delayed_work(priv
->priv_wq
, &priv
->watch_dog_wq
, 0);
3518 mod_timer(&priv
->watch_dog_timer
,
3519 jiffies
+ msecs_to_jiffies(IEEE80211_WATCH_DOG_TIME
));
3521 static int _rtl8192_up(struct net_device
*dev
)
3523 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3524 int init_status
= 0;
3527 priv
->ieee80211
->ieee_up
= 1;
3528 RT_TRACE(COMP_INIT
, "Bringing up iface");
3529 init_status
= rtl8192_adapter_start(dev
);
3531 RT_TRACE(COMP_ERR
, "ERR!!! %s(): initialization failed!\n",
3533 priv
->up
= priv
->ieee80211
->ieee_up
= 0;
3536 RT_TRACE(COMP_INIT
, "start adapter finished\n");
3537 rtl8192_rx_enable(dev
);
3538 if (priv
->ieee80211
->state
!= IEEE80211_LINKED
)
3539 ieee80211_softmac_start_protocol(priv
->ieee80211
);
3540 ieee80211_reset_queue(priv
->ieee80211
);
3541 watch_dog_timer_callback((unsigned long)dev
);
3542 if (!netif_queue_stopped(dev
))
3543 netif_start_queue(dev
);
3545 netif_wake_queue(dev
);
3551 static int rtl8192_open(struct net_device
*dev
)
3553 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3556 down(&priv
->wx_sem
);
3557 ret
= rtl8192_up(dev
);
3564 int rtl8192_up(struct net_device
*dev
)
3566 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3571 return _rtl8192_up(dev
);
3575 static int rtl8192_close(struct net_device
*dev
)
3577 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3580 down(&priv
->wx_sem
);
3582 ret
= rtl8192_down(dev
);
3590 int rtl8192_down(struct net_device
*dev
)
3592 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3599 priv
->ieee80211
->ieee_up
= 0;
3600 RT_TRACE(COMP_DOWN
, "==========>%s()\n", __func__
);
3602 if (!netif_queue_stopped(dev
))
3603 netif_stop_queue(dev
);
3605 rtl8192_rtx_disable(dev
);
3607 /* Tx related queue release */
3608 for (i
= 0; i
< MAX_QUEUE_SIZE
; i
++)
3609 skb_queue_purge(&priv
->ieee80211
->skb_waitQ
[i
]);
3610 for (i
= 0; i
< MAX_QUEUE_SIZE
; i
++)
3611 skb_queue_purge(&priv
->ieee80211
->skb_aggQ
[i
]);
3613 for (i
= 0; i
< MAX_QUEUE_SIZE
; i
++)
3614 skb_queue_purge(&priv
->ieee80211
->skb_drv_aggQ
[i
]);
3616 /* as cancel_delayed_work will del work->timer, so if work is not
3617 * defined as struct delayed_work, it will corrupt
3619 rtl8192_cancel_deferred_work(priv
);
3621 del_timer_sync(&priv
->watch_dog_timer
);
3624 ieee80211_softmac_stop_protocol(priv
->ieee80211
);
3625 memset(&priv
->ieee80211
->current_network
, 0,
3626 offsetof(struct ieee80211_network
, list
));
3627 RT_TRACE(COMP_DOWN
, "<==========%s()\n", __func__
);
3633 void rtl8192_commit(struct net_device
*dev
)
3635 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3636 int reset_status
= 0;
3642 rtl8192_cancel_deferred_work(priv
);
3643 del_timer_sync(&priv
->watch_dog_timer
);
3645 ieee80211_softmac_stop_protocol(priv
->ieee80211
);
3647 rtl8192_rtx_disable(dev
);
3648 reset_status
= _rtl8192_up(dev
);
3652 static void rtl8192_restart(struct work_struct
*work
)
3654 struct r8192_priv
*priv
= container_of(work
, struct r8192_priv
,
3656 struct net_device
*dev
= priv
->ieee80211
->dev
;
3658 down(&priv
->wx_sem
);
3660 rtl8192_commit(dev
);
3665 static void r8192_set_multicast(struct net_device
*dev
)
3667 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3672 promisc
= (dev
->flags
& IFF_PROMISC
) ? 1 : 0;
3674 if (promisc
!= priv
->promisc
)
3676 priv
->promisc
= promisc
;
3680 static int r8192_set_mac_adr(struct net_device
*dev
, void *mac
)
3682 struct r8192_priv
*priv
= ieee80211_priv(dev
);
3683 struct sockaddr
*addr
= mac
;
3685 down(&priv
->wx_sem
);
3687 ether_addr_copy(dev
->dev_addr
, addr
->sa_data
);
3689 schedule_work(&priv
->reset_wq
);
3695 /* based on ipw2200 driver */
3696 static int rtl8192_ioctl(struct net_device
*dev
, struct ifreq
*rq
, int cmd
)
3698 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
3699 struct iwreq
*wrq
= (struct iwreq
*)rq
;
3701 struct ieee80211_device
*ieee
= priv
->ieee80211
;
3703 u8 broadcast_addr
[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
3704 struct iw_point
*p
= &wrq
->u
.data
;
3705 struct ieee_param
*ipw
= NULL
;
3707 down(&priv
->wx_sem
);
3710 if (p
->length
< sizeof(struct ieee_param
) || !p
->pointer
) {
3715 ipw
= memdup_user(p
->pointer
, p
->length
);
3722 case RTL_IOCTL_WPA_SUPPLICANT
:
3723 /* parse here for HW security */
3724 if (ipw
->cmd
== IEEE_CMD_SET_ENCRYPTION
) {
3725 if (ipw
->u
.crypt
.set_tx
) {
3726 if (strcmp(ipw
->u
.crypt
.alg
, "CCMP") == 0) {
3727 ieee
->pairwise_key_type
= KEY_TYPE_CCMP
;
3728 } else if (strcmp(ipw
->u
.crypt
.alg
, "TKIP") == 0) {
3729 ieee
->pairwise_key_type
= KEY_TYPE_TKIP
;
3730 } else if (strcmp(ipw
->u
.crypt
.alg
, "WEP") == 0) {
3731 if (ipw
->u
.crypt
.key_len
== 13)
3732 ieee
->pairwise_key_type
= KEY_TYPE_WEP104
;
3733 else if (ipw
->u
.crypt
.key_len
== 5)
3734 ieee
->pairwise_key_type
= KEY_TYPE_WEP40
;
3736 ieee
->pairwise_key_type
= KEY_TYPE_NA
;
3739 if (ieee
->pairwise_key_type
) {
3740 memcpy((u8
*)key
, ipw
->u
.crypt
.key
, 16);
3741 EnableHWSecurityConfig8192(dev
);
3742 /* We fill both index entry and 4th
3743 * entry for pairwise key as in IPW
3744 * interface, adhoc will only get here,
3745 * so we need index entry for its
3746 * default key serching!
3748 setKey(dev
, 4, ipw
->u
.crypt
.idx
,
3749 ieee
->pairwise_key_type
,
3750 (u8
*)ieee
->ap_mac_addr
,
3752 if (ieee
->auth_mode
!= 2)
3753 setKey(dev
, ipw
->u
.crypt
.idx
,
3755 ieee
->pairwise_key_type
,
3756 (u8
*)ieee
->ap_mac_addr
,
3760 memcpy((u8
*)key
, ipw
->u
.crypt
.key
, 16);
3761 if (strcmp(ipw
->u
.crypt
.alg
, "CCMP") == 0) {
3762 ieee
->group_key_type
= KEY_TYPE_CCMP
;
3763 } else if (strcmp(ipw
->u
.crypt
.alg
, "TKIP") == 0) {
3764 ieee
->group_key_type
= KEY_TYPE_TKIP
;
3765 } else if (strcmp(ipw
->u
.crypt
.alg
, "WEP") == 0) {
3766 if (ipw
->u
.crypt
.key_len
== 13)
3767 ieee
->group_key_type
= KEY_TYPE_WEP104
;
3768 else if (ipw
->u
.crypt
.key_len
== 5)
3769 ieee
->group_key_type
= KEY_TYPE_WEP40
;
3771 ieee
->group_key_type
= KEY_TYPE_NA
;
3774 if (ieee
->group_key_type
) {
3775 setKey(dev
, ipw
->u
.crypt
.idx
,
3779 ieee
->group_key_type
,
3789 ret
= ieee80211_wpa_supplicant_ioctl(priv
->ieee80211
,
3804 static u8
HwRateToMRate90(bool bIsHT
, u8 rate
)
3816 case DESC90_RATE5_5M
:
3817 ret_rate
= MGN_5_5M
;
3819 case DESC90_RATE11M
:
3828 case DESC90_RATE12M
:
3831 case DESC90_RATE18M
:
3834 case DESC90_RATE24M
:
3837 case DESC90_RATE36M
:
3840 case DESC90_RATE48M
:
3843 case DESC90_RATE54M
:
3850 "HwRateToMRate90(): Non supported Rate [%x], bIsHT = %d!!!\n",
3857 case DESC90_RATEMCS0
:
3858 ret_rate
= MGN_MCS0
;
3860 case DESC90_RATEMCS1
:
3861 ret_rate
= MGN_MCS1
;
3863 case DESC90_RATEMCS2
:
3864 ret_rate
= MGN_MCS2
;
3866 case DESC90_RATEMCS3
:
3867 ret_rate
= MGN_MCS3
;
3869 case DESC90_RATEMCS4
:
3870 ret_rate
= MGN_MCS4
;
3872 case DESC90_RATEMCS5
:
3873 ret_rate
= MGN_MCS5
;
3875 case DESC90_RATEMCS6
:
3876 ret_rate
= MGN_MCS6
;
3878 case DESC90_RATEMCS7
:
3879 ret_rate
= MGN_MCS7
;
3881 case DESC90_RATEMCS8
:
3882 ret_rate
= MGN_MCS8
;
3884 case DESC90_RATEMCS9
:
3885 ret_rate
= MGN_MCS9
;
3887 case DESC90_RATEMCS10
:
3888 ret_rate
= MGN_MCS10
;
3890 case DESC90_RATEMCS11
:
3891 ret_rate
= MGN_MCS11
;
3893 case DESC90_RATEMCS12
:
3894 ret_rate
= MGN_MCS12
;
3896 case DESC90_RATEMCS13
:
3897 ret_rate
= MGN_MCS13
;
3899 case DESC90_RATEMCS14
:
3900 ret_rate
= MGN_MCS14
;
3902 case DESC90_RATEMCS15
:
3903 ret_rate
= MGN_MCS15
;
3905 case DESC90_RATEMCS32
:
3906 ret_rate
= 0x80 | 0x20;
3912 "HwRateToMRate90(): Non supported Rate [%x], bIsHT = %d!!!\n",
3922 * Function: UpdateRxPktTimeStamp
3923 * Overview: Record the TSF time stamp when receiving a packet
3931 * (pRfd->Status.TimeStampHigh is updated)
3932 * (pRfd->Status.TimeStampLow is updated)
3936 static void UpdateRxPktTimeStamp8190(struct net_device
*dev
,
3937 struct ieee80211_rx_stats
*stats
)
3939 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
3941 if (stats
->bIsAMPDU
&& !stats
->bFirstMPDU
) {
3942 stats
->mac_time
[0] = priv
->LastRxDescTSFLow
;
3943 stats
->mac_time
[1] = priv
->LastRxDescTSFHigh
;
3945 priv
->LastRxDescTSFLow
= stats
->mac_time
[0];
3946 priv
->LastRxDescTSFHigh
= stats
->mac_time
[1];
3951 static long rtl819x_translate_todbm(u8 signal_strength_index
)
3953 long signal_power
; /* in dBm. */
3955 /* Translate to dBm (x=0.5y-95). */
3956 signal_power
= (long)((signal_strength_index
+ 1) >> 1);
3959 return signal_power
;
3963 /* We can not declare RSSI/EVM total value of sliding window to
3964 * be a local static. Otherwise, it may increase when we return from S3/S4. The
3965 * value will be kept in memory or disk. Declare the value in the adaptor
3966 * and it will be reinitialized when returned from S3/S4.
3968 static void rtl8192_process_phyinfo(struct r8192_priv
*priv
, u8
*buffer
,
3969 struct ieee80211_rx_stats
*pprevious_stats
,
3970 struct ieee80211_rx_stats
*pcurrent_stats
)
3972 bool bcheck
= false;
3974 u32 nspatial_stream
, tmp_val
;
3975 static u32 slide_rssi_index
, slide_rssi_statistics
;
3976 static u32 slide_evm_index
, slide_evm_statistics
;
3977 static u32 last_rssi
, last_evm
;
3979 static u32 slide_beacon_adc_pwdb_index
;
3980 static u32 slide_beacon_adc_pwdb_statistics
;
3981 static u32 last_beacon_adc_pwdb
;
3983 struct rtl_80211_hdr_3addr
*hdr
;
3985 unsigned int frag
, seq
;
3987 hdr
= (struct rtl_80211_hdr_3addr
*)buffer
;
3988 sc
= le16_to_cpu(hdr
->seq_ctl
);
3989 frag
= WLAN_GET_SEQ_FRAG(sc
);
3990 seq
= WLAN_GET_SEQ_SEQ(sc
);
3991 /* to record the sequence number */
3992 pcurrent_stats
->Seq_Num
= seq
;
3994 /* Check whether we should take the previous packet into accounting */
3995 if (!pprevious_stats
->bIsAMPDU
) {
3996 /* if previous packet is not aggregated packet */
4000 if (slide_rssi_statistics
++ >= PHY_RSSI_SLID_WIN_MAX
) {
4001 slide_rssi_statistics
= PHY_RSSI_SLID_WIN_MAX
;
4002 last_rssi
= priv
->stats
.slide_signal_strength
[slide_rssi_index
];
4003 priv
->stats
.slide_rssi_total
-= last_rssi
;
4005 priv
->stats
.slide_rssi_total
+= pprevious_stats
->SignalStrength
;
4007 priv
->stats
.slide_signal_strength
[slide_rssi_index
++] =
4008 pprevious_stats
->SignalStrength
;
4009 if (slide_rssi_index
>= PHY_RSSI_SLID_WIN_MAX
)
4010 slide_rssi_index
= 0;
4012 /* <1> Showed on UI for user, in dbm */
4013 tmp_val
= priv
->stats
.slide_rssi_total
/ slide_rssi_statistics
;
4014 priv
->stats
.signal_strength
= rtl819x_translate_todbm((u8
)tmp_val
);
4015 pcurrent_stats
->rssi
= priv
->stats
.signal_strength
;
4017 /* If the previous packet does not match the criteria, neglect it */
4018 if (!pprevious_stats
->bPacketMatchBSSID
) {
4019 if (!pprevious_stats
->bToSelfBA
)
4027 /* only rtl8190 supported
4028 * rtl8190_process_cck_rxpathsel(priv,pprevious_stats);
4032 priv
->stats
.num_process_phyinfo
++;
4034 /* record the general signal strength to the sliding window. */
4037 /* <2> Showed on UI for engineering
4038 * hardware does not provide rssi information for each rf path in CCK
4040 if (!pprevious_stats
->bIsCCK
&&
4041 (pprevious_stats
->bPacketToSelf
|| pprevious_stats
->bToSelfBA
)) {
4042 for (rfpath
= RF90_PATH_A
; rfpath
< priv
->NumTotalRFPath
; rfpath
++) {
4043 if (!rtl8192_phy_CheckIsLegalRFPath(
4044 priv
->ieee80211
->dev
, rfpath
))
4047 if (priv
->stats
.rx_rssi_percentage
[rfpath
] == 0)
4048 priv
->stats
.rx_rssi_percentage
[rfpath
] =
4049 pprevious_stats
->RxMIMOSignalStrength
[rfpath
];
4050 if (pprevious_stats
->RxMIMOSignalStrength
[rfpath
] > priv
->stats
.rx_rssi_percentage
[rfpath
]) {
4051 priv
->stats
.rx_rssi_percentage
[rfpath
] =
4052 ((priv
->stats
.rx_rssi_percentage
[rfpath
] * (Rx_Smooth_Factor
- 1)) +
4053 (pprevious_stats
->RxMIMOSignalStrength
[rfpath
])) / (Rx_Smooth_Factor
);
4054 priv
->stats
.rx_rssi_percentage
[rfpath
] = priv
->stats
.rx_rssi_percentage
[rfpath
] + 1;
4056 priv
->stats
.rx_rssi_percentage
[rfpath
] =
4057 ((priv
->stats
.rx_rssi_percentage
[rfpath
] * (Rx_Smooth_Factor
- 1)) +
4058 (pprevious_stats
->RxMIMOSignalStrength
[rfpath
])) / (Rx_Smooth_Factor
);
4061 "priv->stats.rx_rssi_percentage[rfPath] = %d\n",
4062 priv
->stats
.rx_rssi_percentage
[rfpath
]);
4068 RT_TRACE(COMP_RXDESC
, "Smooth %s PWDB = %d\n",
4069 pprevious_stats
->bIsCCK
? "CCK" : "OFDM",
4070 pprevious_stats
->RxPWDBAll
);
4072 if (pprevious_stats
->bPacketBeacon
) {
4073 /* record the beacon pwdb to the sliding window. */
4074 if (slide_beacon_adc_pwdb_statistics
++ >= PHY_Beacon_RSSI_SLID_WIN_MAX
) {
4075 slide_beacon_adc_pwdb_statistics
= PHY_Beacon_RSSI_SLID_WIN_MAX
;
4076 last_beacon_adc_pwdb
= priv
->stats
.Slide_Beacon_pwdb
[slide_beacon_adc_pwdb_index
];
4077 priv
->stats
.Slide_Beacon_Total
-= last_beacon_adc_pwdb
;
4079 priv
->stats
.Slide_Beacon_Total
+= pprevious_stats
->RxPWDBAll
;
4080 priv
->stats
.Slide_Beacon_pwdb
[slide_beacon_adc_pwdb_index
] = pprevious_stats
->RxPWDBAll
;
4081 slide_beacon_adc_pwdb_index
++;
4082 if (slide_beacon_adc_pwdb_index
>= PHY_Beacon_RSSI_SLID_WIN_MAX
)
4083 slide_beacon_adc_pwdb_index
= 0;
4084 pprevious_stats
->RxPWDBAll
= priv
->stats
.Slide_Beacon_Total
/ slide_beacon_adc_pwdb_statistics
;
4085 if (pprevious_stats
->RxPWDBAll
>= 3)
4086 pprevious_stats
->RxPWDBAll
-= 3;
4089 RT_TRACE(COMP_RXDESC
, "Smooth %s PWDB = %d\n",
4090 pprevious_stats
->bIsCCK
? "CCK" : "OFDM",
4091 pprevious_stats
->RxPWDBAll
);
4094 if (pprevious_stats
->bPacketToSelf
||
4095 pprevious_stats
->bPacketBeacon
||
4096 pprevious_stats
->bToSelfBA
) {
4097 if (priv
->undecorated_smoothed_pwdb
< 0)
4099 priv
->undecorated_smoothed_pwdb
=
4100 pprevious_stats
->RxPWDBAll
;
4101 if (pprevious_stats
->RxPWDBAll
> (u32
)priv
->undecorated_smoothed_pwdb
) {
4102 priv
->undecorated_smoothed_pwdb
=
4103 (((priv
->undecorated_smoothed_pwdb
) * (Rx_Smooth_Factor
- 1)) +
4104 (pprevious_stats
->RxPWDBAll
)) / (Rx_Smooth_Factor
);
4105 priv
->undecorated_smoothed_pwdb
= priv
->undecorated_smoothed_pwdb
+ 1;
4107 priv
->undecorated_smoothed_pwdb
=
4108 (((priv
->undecorated_smoothed_pwdb
) * (Rx_Smooth_Factor
- 1)) +
4109 (pprevious_stats
->RxPWDBAll
)) / (Rx_Smooth_Factor
);
4115 /* record the general EVM to the sliding window. */
4116 if (pprevious_stats
->SignalQuality
) {
4117 if (pprevious_stats
->bPacketToSelf
||
4118 pprevious_stats
->bPacketBeacon
||
4119 pprevious_stats
->bToSelfBA
) {
4120 if (slide_evm_statistics
++ >= PHY_RSSI_SLID_WIN_MAX
) {
4121 slide_evm_statistics
= PHY_RSSI_SLID_WIN_MAX
;
4122 last_evm
= priv
->stats
.slide_evm
[slide_evm_index
];
4123 priv
->stats
.slide_evm_total
-= last_evm
;
4126 priv
->stats
.slide_evm_total
+=
4127 pprevious_stats
->SignalQuality
;
4129 priv
->stats
.slide_evm
[slide_evm_index
++] =
4130 pprevious_stats
->SignalQuality
;
4131 if (slide_evm_index
>= PHY_RSSI_SLID_WIN_MAX
)
4132 slide_evm_index
= 0;
4134 /* <1> Showed on UI for user, in percentage. */
4135 tmp_val
= priv
->stats
.slide_evm_total
/
4136 slide_evm_statistics
;
4137 priv
->stats
.signal_quality
= tmp_val
;
4138 /* Showed on UI for user in Windows Vista,
4141 priv
->stats
.last_signal_strength_inpercent
= tmp_val
;
4144 /* <2> Showed on UI for engineering */
4145 if (pprevious_stats
->bPacketToSelf
||
4146 pprevious_stats
->bPacketBeacon
||
4147 pprevious_stats
->bToSelfBA
) {
4148 for (nspatial_stream
= 0; nspatial_stream
< 2; nspatial_stream
++) { /* 2 spatial stream */
4149 if (pprevious_stats
->RxMIMOSignalQuality
[nspatial_stream
] != -1) {
4150 if (priv
->stats
.rx_evm_percentage
[nspatial_stream
] == 0) /* initialize */
4151 priv
->stats
.rx_evm_percentage
[nspatial_stream
] = pprevious_stats
->RxMIMOSignalQuality
[nspatial_stream
];
4152 priv
->stats
.rx_evm_percentage
[nspatial_stream
] =
4153 ((priv
->stats
.rx_evm_percentage
[nspatial_stream
] * (Rx_Smooth_Factor
- 1)) +
4154 (pprevious_stats
->RxMIMOSignalQuality
[nspatial_stream
] * 1)) / (Rx_Smooth_Factor
);
4163 /*-----------------------------------------------------------------------------
4164 * Function: rtl819x_query_rxpwrpercentage()
4168 * Input: char antpower
4172 * Return: 0-100 percentage
4173 *---------------------------------------------------------------------------*/
4174 static u8
rtl819x_query_rxpwrpercentage(char antpower
)
4176 if ((antpower
<= -100) || (antpower
>= 20))
4178 else if (antpower
>= 0)
4181 return 100 + antpower
;
4183 } /* QueryRxPwrPercentage */
4185 static u8
rtl819x_evm_dbtopercentage(char value
)
4195 ret_val
= 0 - ret_val
;
4201 /* We want good-looking for signal strength/quality */
4202 static long rtl819x_signal_scale_mapping(long currsig
)
4206 /* Step 1. Scale mapping. */
4207 if (currsig
>= 61 && currsig
<= 100)
4208 retsig
= 90 + ((currsig
- 60) / 4);
4209 else if (currsig
>= 41 && currsig
<= 60)
4210 retsig
= 78 + ((currsig
- 40) / 2);
4211 else if (currsig
>= 31 && currsig
<= 40)
4212 retsig
= 66 + (currsig
- 30);
4213 else if (currsig
>= 21 && currsig
<= 30)
4214 retsig
= 54 + (currsig
- 20);
4215 else if (currsig
>= 5 && currsig
<= 20)
4216 retsig
= 42 + (((currsig
- 5) * 2) / 3);
4217 else if (currsig
== 4)
4219 else if (currsig
== 3)
4221 else if (currsig
== 2)
4223 else if (currsig
== 1)
4231 static inline bool rx_hal_is_cck_rate(struct rx_drvinfo_819x_usb
*pdrvinfo
)
4236 switch (pdrvinfo
->RxRate
) {
4239 case DESC90_RATE5_5M
:
4240 case DESC90_RATE11M
:
4247 static void rtl8192_query_rxphystatus(struct r8192_priv
*priv
,
4248 struct ieee80211_rx_stats
*pstats
,
4249 rx_drvinfo_819x_usb
*pdrvinfo
,
4250 struct ieee80211_rx_stats
*precord_stats
,
4251 bool bpacket_match_bssid
,
4252 bool bpacket_toself
,
4256 phy_sts_ofdm_819xusb_t
*pofdm_buf
;
4257 phy_sts_cck_819xusb_t
*pcck_buf
;
4258 phy_ofdm_rx_status_rxsc_sgien_exintfflag
*prxsc
;
4260 u8 i
, max_spatial_stream
, tmp_rxsnr
, tmp_rxevm
, rxsc_sgien_exflg
;
4261 char rx_pwr
[4], rx_pwr_all
= 0;
4262 char rx_snrX
, rx_evmX
;
4264 u32 RSSI
, total_rssi
= 0;
4270 priv
->stats
.numqry_phystatus
++;
4272 is_cck_rate
= rx_hal_is_cck_rate(pdrvinfo
);
4274 /* Record it for next packet processing */
4275 memset(precord_stats
, 0, sizeof(struct ieee80211_rx_stats
));
4276 pstats
->bPacketMatchBSSID
=
4277 precord_stats
->bPacketMatchBSSID
= bpacket_match_bssid
;
4278 pstats
->bPacketToSelf
= precord_stats
->bPacketToSelf
= bpacket_toself
;
4279 pstats
->bIsCCK
= precord_stats
->bIsCCK
= is_cck_rate
;
4280 pstats
->bPacketBeacon
= precord_stats
->bPacketBeacon
= bPacketBeacon
;
4281 pstats
->bToSelfBA
= precord_stats
->bToSelfBA
= bToSelfBA
;
4283 prxpkt
= (u8
*)pdrvinfo
;
4285 /* Move pointer to the 16th bytes. Phy status start address. */
4286 prxpkt
+= sizeof(rx_drvinfo_819x_usb
);
4288 /* Initial the cck and ofdm buffer pointer */
4289 pcck_buf
= (phy_sts_cck_819xusb_t
*)prxpkt
;
4290 pofdm_buf
= (phy_sts_ofdm_819xusb_t
*)prxpkt
;
4292 pstats
->RxMIMOSignalQuality
[0] = -1;
4293 pstats
->RxMIMOSignalQuality
[1] = -1;
4294 precord_stats
->RxMIMOSignalQuality
[0] = -1;
4295 precord_stats
->RxMIMOSignalQuality
[1] = -1;
4298 /* (1)Hardware does not provide RSSI for CCK */
4300 /* (2)PWDB, Average PWDB cacluated by hardware
4301 * (for rate adaptive)
4305 priv
->stats
.numqry_phystatusCCK
++;
4307 if (!priv
->bCckHighPower
) {
4308 report
= pcck_buf
->cck_agc_rpt
& 0xc0;
4312 rx_pwr_all
= -35 - (pcck_buf
->cck_agc_rpt
& 0x3e);
4315 rx_pwr_all
= -23 - (pcck_buf
->cck_agc_rpt
& 0x3e);
4318 rx_pwr_all
= -11 - (pcck_buf
->cck_agc_rpt
& 0x3e);
4321 rx_pwr_all
= 6 - (pcck_buf
->cck_agc_rpt
& 0x3e);
4325 report
= pcck_buf
->cck_agc_rpt
& 0x60;
4329 rx_pwr_all
= -35 - ((pcck_buf
->cck_agc_rpt
& 0x1f) << 1);
4332 rx_pwr_all
= -23 - ((pcck_buf
->cck_agc_rpt
& 0x1f) << 1);
4335 rx_pwr_all
= -11 - ((pcck_buf
->cck_agc_rpt
& 0x1f) << 1);
4338 rx_pwr_all
= 6 - ((pcck_buf
->cck_agc_rpt
& 0x1f) << 1);
4343 pwdb_all
= rtl819x_query_rxpwrpercentage(rx_pwr_all
);
4344 pstats
->RxPWDBAll
= precord_stats
->RxPWDBAll
= pwdb_all
;
4345 pstats
->RecvSignalPower
= pwdb_all
;
4347 /* (3) Get Signal Quality (EVM) */
4349 if (pstats
->RxPWDBAll
> 40) {
4352 sq
= pcck_buf
->sq_rpt
;
4354 if (pcck_buf
->sq_rpt
> 64)
4356 else if (pcck_buf
->sq_rpt
< 20)
4359 sq
= ((64 - sq
) * 100) / 44;
4361 pstats
->SignalQuality
= precord_stats
->SignalQuality
= sq
;
4362 pstats
->RxMIMOSignalQuality
[0] =
4363 precord_stats
->RxMIMOSignalQuality
[0] = sq
;
4364 pstats
->RxMIMOSignalQuality
[1] =
4365 precord_stats
->RxMIMOSignalQuality
[1] = -1;
4368 priv
->stats
.numqry_phystatusHT
++;
4370 /* (1)Get RSSI for HT rate */
4371 for (i
= RF90_PATH_A
; i
< priv
->NumTotalRFPath
; i
++) {
4372 /* We will judge RF RX path now. */
4373 if (priv
->brfpath_rxenable
[i
])
4378 if (!rtl8192_phy_CheckIsLegalRFPath(
4379 priv
->ieee80211
->dev
, i
))
4383 ((pofdm_buf
->trsw_gain_X
[i
] & 0x3F) * 2) - 106;
4385 /* Get Rx snr value in DB */
4386 tmp_rxsnr
= pofdm_buf
->rxsnr_X
[i
];
4387 rx_snrX
= (char)(tmp_rxsnr
);
4389 priv
->stats
.rxSNRdB
[i
] = (long)rx_snrX
;
4391 /* Translate DBM to percentage. */
4392 RSSI
= rtl819x_query_rxpwrpercentage(rx_pwr
[i
]);
4395 /* Record Signal Strength for next packet */
4396 pstats
->RxMIMOSignalStrength
[i
] = (u8
)RSSI
;
4397 precord_stats
->RxMIMOSignalStrength
[i
] = (u8
)RSSI
;
4401 /* (2)PWDB, Average PWDB cacluated by hardware
4402 * (for rate adaptive)
4404 rx_pwr_all
= (((pofdm_buf
->pwdb_all
) >> 1) & 0x7f) - 106;
4405 pwdb_all
= rtl819x_query_rxpwrpercentage(rx_pwr_all
);
4407 pstats
->RxPWDBAll
= precord_stats
->RxPWDBAll
= pwdb_all
;
4408 pstats
->RxPower
= precord_stats
->RxPower
= rx_pwr_all
;
4410 /* (3)EVM of HT rate */
4411 if (pdrvinfo
->RxHT
&& pdrvinfo
->RxRate
>= DESC90_RATEMCS8
&&
4412 pdrvinfo
->RxRate
<= DESC90_RATEMCS15
)
4413 /* both spatial stream make sense */
4414 max_spatial_stream
= 2;
4416 /* only spatial stream 1 makes sense */
4417 max_spatial_stream
= 1;
4419 for (i
= 0; i
< max_spatial_stream
; i
++) {
4420 tmp_rxevm
= pofdm_buf
->rxevm_X
[i
];
4421 rx_evmX
= (char)(tmp_rxevm
);
4423 /* Do not use shift operation like "rx_evmX >>= 1"
4424 * because the compiler of free build environment will
4425 * set the most significant bit to "zero" when doing
4426 * shifting operation which may change a negative value
4427 * to positive one, then the dbm value (which is
4428 * supposed to be negative) is not correct anymore.
4430 rx_evmX
/= 2; /* dbm */
4432 evm
= rtl819x_evm_dbtopercentage(rx_evmX
);
4434 /* Fill value in RFD, Get the first spatial
4437 pstats
->SignalQuality
=
4438 precord_stats
->SignalQuality
=
4440 pstats
->RxMIMOSignalQuality
[i
] =
4441 precord_stats
->RxMIMOSignalQuality
[i
] =
4446 /* record rx statistics for debug */
4447 rxsc_sgien_exflg
= pofdm_buf
->rxsc_sgien_exflg
;
4448 prxsc
= (phy_ofdm_rx_status_rxsc_sgien_exintfflag
*)
4450 if (pdrvinfo
->BW
) /* 40M channel */
4451 priv
->stats
.received_bwtype
[1 + prxsc
->rxsc
]++;
4452 else /* 20M channel */
4453 priv
->stats
.received_bwtype
[0]++;
4456 /* UI BSS List signal strength(in percentage), make it good looking,
4457 * from 0~100. It is assigned to the BSS List in
4458 * GetValueFromBeaconOrProbeRsp().
4461 pstats
->SignalStrength
=
4462 precord_stats
->SignalStrength
=
4463 (u8
)(rtl819x_signal_scale_mapping((long)pwdb_all
));
4465 /* We can judge RX path number now. */
4466 if (rf_rx_num
!= 0) {
4467 pstats
->SignalStrength
=
4468 precord_stats
->SignalStrength
=
4469 (u8
)(rtl819x_signal_scale_mapping((long)(total_rssi
/= rf_rx_num
)));
4472 } /* QueryRxPhyStatus8190Pci */
4474 static void rtl8192_record_rxdesc_forlateruse(
4475 struct ieee80211_rx_stats
*psrc_stats
,
4476 struct ieee80211_rx_stats
*ptarget_stats
)
4478 ptarget_stats
->bIsAMPDU
= psrc_stats
->bIsAMPDU
;
4479 ptarget_stats
->bFirstMPDU
= psrc_stats
->bFirstMPDU
;
4480 ptarget_stats
->Seq_Num
= psrc_stats
->Seq_Num
;
4484 static void TranslateRxSignalStuff819xUsb(struct sk_buff
*skb
,
4485 struct ieee80211_rx_stats
*pstats
,
4486 rx_drvinfo_819x_usb
*pdrvinfo
)
4488 /* TODO: We must only check packet for current MAC address.
4491 struct rtl8192_rx_info
*info
= (struct rtl8192_rx_info
*)skb
->cb
;
4492 struct net_device
*dev
= info
->dev
;
4493 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
4494 bool bpacket_match_bssid
, bpacket_toself
;
4495 bool bPacketBeacon
= false, bToSelfBA
= false;
4496 static struct ieee80211_rx_stats previous_stats
;
4497 struct rtl_80211_hdr_3addr
*hdr
;
4500 /* Get Signal Quality for only RX data queue (but not command queue) */
4505 /* Get MAC frame start address. */
4506 tmp_buf
= (u8
*)skb
->data
;
4508 hdr
= (struct rtl_80211_hdr_3addr
*)tmp_buf
;
4509 fc
= le16_to_cpu(hdr
->frame_ctl
);
4510 type
= WLAN_FC_GET_TYPE(fc
);
4511 praddr
= hdr
->addr1
;
4513 /* Check if the received packet is acceptable. */
4514 bpacket_match_bssid
= (IEEE80211_FTYPE_CTL
!= type
) &&
4515 (eqMacAddr(priv
->ieee80211
->current_network
.bssid
, (fc
& IEEE80211_FCTL_TODS
) ? hdr
->addr1
: (fc
& IEEE80211_FCTL_FROMDS
) ? hdr
->addr2
: hdr
->addr3
))
4516 && (!pstats
->bHwError
) && (!pstats
->bCRC
) && (!pstats
->bICV
);
4517 bpacket_toself
= bpacket_match_bssid
&
4518 (eqMacAddr(praddr
, priv
->ieee80211
->dev
->dev_addr
));
4520 if (WLAN_FC_GET_FRAMETYPE(fc
) == IEEE80211_STYPE_BEACON
)
4521 bPacketBeacon
= true;
4522 if (WLAN_FC_GET_FRAMETYPE(fc
) == IEEE80211_STYPE_BLOCKACK
) {
4523 if ((eqMacAddr(praddr
, dev
->dev_addr
)))
4529 if (bpacket_match_bssid
)
4530 priv
->stats
.numpacket_matchbssid
++;
4532 priv
->stats
.numpacket_toself
++;
4533 /* Process PHY information for previous packet (RSSI/PWDB/EVM)
4534 * Because phy information is contained in the last packet of AMPDU
4535 * only, so driver should process phy information of previous packet
4537 rtl8192_process_phyinfo(priv
, tmp_buf
, &previous_stats
, pstats
);
4538 rtl8192_query_rxphystatus(priv
, pstats
, pdrvinfo
, &previous_stats
,
4539 bpacket_match_bssid
, bpacket_toself
,
4540 bPacketBeacon
, bToSelfBA
);
4541 rtl8192_record_rxdesc_forlateruse(pstats
, &previous_stats
);
4546 * Function: UpdateReceivedRateHistogramStatistics
4547 * Overview: Record the received data rate
4550 * struct net_device *dev
4551 * struct ieee80211_rx_stats *stats
4555 * (priv->stats.ReceivedRateHistogram[] is updated)
4560 UpdateReceivedRateHistogramStatistics8190(struct net_device
*dev
,
4561 struct ieee80211_rx_stats
*stats
)
4563 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
4564 /* 0: Total, 1:OK, 2:CRC, 3:ICV */
4567 /* 1: short preamble/GI, 0: long preamble/GI */
4568 u32 preamble_guardinterval
;
4573 else if (stats
->bICV
)
4576 if (stats
->bShortPreamble
)
4577 preamble_guardinterval
= 1; /* short */
4579 preamble_guardinterval
= 0; /* long */
4581 switch (stats
->rate
) {
4595 /* Legacy OFDM rate */
4620 /* 11n High throughput rate */
4673 priv
->stats
.received_preamble_GI
[preamble_guardinterval
][rateIndex
]++;
4674 priv
->stats
.received_rate_histogram
[0][rateIndex
]++; /* total */
4675 priv
->stats
.received_rate_histogram
[rcvType
][rateIndex
]++;
4679 static void query_rxdesc_status(struct sk_buff
*skb
,
4680 struct ieee80211_rx_stats
*stats
,
4681 bool bIsRxAggrSubframe
)
4683 struct rtl8192_rx_info
*info
= (struct rtl8192_rx_info
*)skb
->cb
;
4684 struct net_device
*dev
= info
->dev
;
4685 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
4686 rx_drvinfo_819x_usb
*driver_info
= NULL
;
4688 /* Get Rx Descriptor Information */
4689 rx_desc_819x_usb
*desc
= (rx_desc_819x_usb
*)skb
->data
;
4691 stats
->Length
= desc
->Length
;
4692 stats
->RxDrvInfoSize
= desc
->RxDrvInfoSize
;
4693 stats
->RxBufShift
= 0;
4694 stats
->bICV
= desc
->ICV
;
4695 stats
->bCRC
= desc
->CRC32
;
4696 stats
->bHwError
= stats
->bCRC
| stats
->bICV
;
4697 /* RTL8190 set this bit to indicate that Hw does not decrypt packet */
4698 stats
->Decrypted
= !desc
->SWDec
;
4700 if ((priv
->ieee80211
->pHTInfo
->bCurrentHTSupport
) &&
4701 (priv
->ieee80211
->pairwise_key_type
== KEY_TYPE_CCMP
))
4702 stats
->bHwError
= false;
4704 stats
->bHwError
= stats
->bCRC
| stats
->bICV
;
4706 if (stats
->Length
< 24 || stats
->Length
> MAX_8192U_RX_SIZE
)
4707 stats
->bHwError
|= 1;
4708 /* Get Driver Info */
4709 /* TODO: Need to verify it on FGPA platform
4710 * Driver info are written to the RxBuffer following rx desc
4712 if (stats
->RxDrvInfoSize
!= 0) {
4713 driver_info
= (rx_drvinfo_819x_usb
*)(
4715 + sizeof(rx_desc_819x_usb
)
4720 if (!stats
->bHwError
) {
4723 ret_rate
= HwRateToMRate90(driver_info
->RxHT
,
4724 driver_info
->RxRate
);
4725 if (ret_rate
== 0xff) {
4726 /* Abnormal Case: Receive CRC OK packet with Rx
4727 * descriptor indicating non supported rate.
4728 * Special Error Handling here
4731 stats
->bHwError
= 1;
4732 /* Set 1M rate by default */
4733 stats
->rate
= MGN_1M
;
4735 stats
->rate
= ret_rate
;
4741 stats
->bShortPreamble
= driver_info
->SPLCP
;
4744 UpdateReceivedRateHistogramStatistics8190(dev
, stats
);
4746 stats
->bIsAMPDU
= (driver_info
->PartAggr
== 1);
4747 stats
->bFirstMPDU
= (driver_info
->PartAggr
== 1) &&
4748 (driver_info
->FirstAGGR
== 1);
4749 stats
->TimeStampLow
= driver_info
->TSFL
;
4751 UpdateRxPktTimeStamp8190(dev
, stats
);
4754 if (driver_info
->FirstAGGR
== 1 || driver_info
->PartAggr
== 1)
4755 RT_TRACE(COMP_RXDESC
,
4756 "driver_info->FirstAGGR = %d, driver_info->PartAggr = %d\n",
4757 driver_info
->FirstAGGR
, driver_info
->PartAggr
);
4761 skb_pull(skb
, sizeof(rx_desc_819x_usb
));
4762 /* Get Total offset of MPDU Frame Body */
4763 if ((stats
->RxBufShift
+ stats
->RxDrvInfoSize
) > 0) {
4765 skb_pull(skb
, stats
->RxBufShift
+ stats
->RxDrvInfoSize
);
4769 stats
->RxIs40MHzPacket
= driver_info
->BW
;
4770 TranslateRxSignalStuff819xUsb(skb
, stats
, driver_info
);
4774 static void rtl8192_rx_nomal(struct sk_buff
*skb
)
4776 struct rtl8192_rx_info
*info
= (struct rtl8192_rx_info
*)skb
->cb
;
4777 struct net_device
*dev
= info
->dev
;
4778 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
4779 struct ieee80211_rx_stats stats
= {
4781 .noise
= 0x100 - 98,
4783 .freq
= IEEE80211_24GHZ_BAND
,
4786 struct rtl_80211_hdr_1addr
*ieee80211_hdr
= NULL
;
4787 bool unicast_packet
= false;
4789 /* 20 is for ps-poll */
4790 if ((skb
->len
>= (20 + sizeof(rx_desc_819x_usb
))) && (skb
->len
< RX_URB_SIZE
)) {
4791 /* first packet should not contain Rx aggregation header */
4792 query_rxdesc_status(skb
, &stats
, false);
4794 /* hardware related info */
4795 /* Process the MPDU received */
4796 skb_trim(skb
, skb
->len
- 4/*sCrcLng*/);
4798 rx_pkt_len
= skb
->len
;
4799 ieee80211_hdr
= (struct rtl_80211_hdr_1addr
*)skb
->data
;
4800 unicast_packet
= false;
4801 if (is_broadcast_ether_addr(ieee80211_hdr
->addr1
)) {
4803 } else if (is_multicast_ether_addr(ieee80211_hdr
->addr1
)) {
4806 /* unicast packet */
4807 unicast_packet
= true;
4810 if (!ieee80211_rx(priv
->ieee80211
, skb
, &stats
)) {
4811 dev_kfree_skb_any(skb
);
4813 priv
->stats
.rxoktotal
++;
4815 priv
->stats
.rxbytesunicast
+= rx_pkt_len
;
4818 priv
->stats
.rxurberr
++;
4819 netdev_dbg(dev
, "actual_length: %d\n", skb
->len
);
4820 dev_kfree_skb_any(skb
);
4825 static void rtl819xusb_process_received_packet(
4826 struct net_device
*dev
,
4827 struct ieee80211_rx_stats
*pstats
)
4831 struct r8192_priv
*priv
= ieee80211_priv(dev
);
4833 /* Get shifted bytes of Starting address of 802.11 header. */
4834 pstats
->virtual_address
+= get_rxpacket_shiftbytes_819xusb(pstats
);
4835 frame
= pstats
->virtual_address
;
4836 frame_len
= pstats
->packetlength
;
4837 #ifdef TODO /* about HCT */
4838 if (!Adapter
->bInHctTest
)
4839 CountRxErrStatistics(Adapter
, pRfd
);
4841 #ifdef ENABLE_PS /* for adding ps function in future */
4842 RT_RF_POWER_STATE rtState
;
4843 /* When RF is off, we should not count the packet for hw/sw synchronize
4844 * reason, ie. there may be a duration while sw switch is changed and
4845 * hw switch is being changed.
4847 Adapter
->HalFunc
.GetHwRegHandler(Adapter
, HW_VAR_RF_STATE
,
4849 if (rtState
== eRfOff
)
4852 priv
->stats
.rxframgment
++;
4855 RmMonitorSignalStrength(Adapter
, pRfd
);
4857 /* We have to release RFD and return if rx pkt is cmd pkt. */
4858 if (rtl819xusb_rx_command_packet(dev
, pstats
))
4868 static void query_rx_cmdpkt_desc_status(struct sk_buff
*skb
,
4869 struct ieee80211_rx_stats
*stats
)
4871 rx_desc_819x_usb
*desc
= (rx_desc_819x_usb
*)skb
->data
;
4873 /* Get Rx Descriptor Information */
4874 stats
->virtual_address
= (u8
*)skb
->data
;
4875 stats
->Length
= desc
->Length
;
4876 stats
->RxDrvInfoSize
= 0;
4877 stats
->RxBufShift
= 0;
4878 stats
->packetlength
= stats
->Length
- scrclng
;
4879 stats
->fraglength
= stats
->packetlength
;
4880 stats
->fragoffset
= 0;
4881 stats
->ntotalfrag
= 1;
4885 static void rtl8192_rx_cmd(struct sk_buff
*skb
)
4887 struct rtl8192_rx_info
*info
= (struct rtl8192_rx_info
*)skb
->cb
;
4888 struct net_device
*dev
= info
->dev
;
4890 struct ieee80211_rx_stats stats
= {
4892 .noise
= 0x100 - 98,
4894 .freq
= IEEE80211_24GHZ_BAND
,
4897 if ((skb
->len
>= (20 + sizeof(rx_desc_819x_usb
))) && (skb
->len
< RX_URB_SIZE
)) {
4899 query_rx_cmdpkt_desc_status(skb
, &stats
);
4900 /* prfd->queue_id = 1; */
4902 /* Process the command packet received. */
4904 rtl819xusb_process_received_packet(dev
, &stats
);
4906 dev_kfree_skb_any(skb
);
4910 static void rtl8192_irq_rx_tasklet(struct r8192_priv
*priv
)
4912 struct sk_buff
*skb
;
4913 struct rtl8192_rx_info
*info
;
4915 while (NULL
!= (skb
= skb_dequeue(&priv
->skb_queue
))) {
4916 info
= (struct rtl8192_rx_info
*)skb
->cb
;
4917 switch (info
->out_pipe
) {
4918 /* Nomal packet pipe */
4920 priv
->IrpPendingCount
--;
4921 rtl8192_rx_nomal(skb
);
4924 /* Command packet pipe */
4926 RT_TRACE(COMP_RECV
, "command in-pipe index(%d)\n",
4929 rtl8192_rx_cmd(skb
);
4932 default: /* should never get here! */
4933 RT_TRACE(COMP_ERR
, "Unknown in-pipe index(%d)\n",
4942 static const struct net_device_ops rtl8192_netdev_ops
= {
4943 .ndo_open
= rtl8192_open
,
4944 .ndo_stop
= rtl8192_close
,
4945 .ndo_get_stats
= rtl8192_stats
,
4946 .ndo_tx_timeout
= tx_timeout
,
4947 .ndo_do_ioctl
= rtl8192_ioctl
,
4948 .ndo_set_rx_mode
= r8192_set_multicast
,
4949 .ndo_set_mac_address
= r8192_set_mac_adr
,
4950 .ndo_validate_addr
= eth_validate_addr
,
4951 .ndo_change_mtu
= eth_change_mtu
,
4952 .ndo_start_xmit
= ieee80211_xmit
,
4956 /****************************************************************************
4957 ---------------------------- USB_STUFF---------------------------
4958 *****************************************************************************/
4960 static int rtl8192_usb_probe(struct usb_interface
*intf
,
4961 const struct usb_device_id
*id
)
4963 struct net_device
*dev
= NULL
;
4964 struct r8192_priv
*priv
= NULL
;
4965 struct usb_device
*udev
= interface_to_usbdev(intf
);
4968 RT_TRACE(COMP_INIT
, "Oops: i'm coming\n");
4970 dev
= alloc_ieee80211(sizeof(struct r8192_priv
));
4974 usb_set_intfdata(intf
, dev
);
4975 SET_NETDEV_DEV(dev
, &intf
->dev
);
4976 priv
= ieee80211_priv(dev
);
4977 priv
->ieee80211
= netdev_priv(dev
);
4980 dev
->netdev_ops
= &rtl8192_netdev_ops
;
4982 dev
->wireless_handlers
=
4983 (struct iw_handler_def
*)&r8192_wx_handlers_def
;
4985 dev
->type
= ARPHRD_ETHER
;
4987 dev
->watchdog_timeo
= HZ
* 3;
4989 if (dev_alloc_name(dev
, ifname
) < 0) {
4991 "Oops: devname already taken! Trying wlan%%d...\n");
4993 dev_alloc_name(dev
, ifname
);
4996 RT_TRACE(COMP_INIT
, "Driver probe completed1\n");
4997 if (rtl8192_init(dev
) != 0) {
4998 RT_TRACE(COMP_ERR
, "Initialization failed");
5002 netif_carrier_off(dev
);
5003 netif_stop_queue(dev
);
5005 ret
= register_netdev(dev
);
5009 RT_TRACE(COMP_INIT
, "dev name=======> %s\n", dev
->name
);
5010 rtl8192_proc_init_one(dev
);
5013 RT_TRACE(COMP_INIT
, "Driver probe completed\n");
5018 kfree(priv
->pFirmware
);
5019 priv
->pFirmware
= NULL
;
5020 rtl8192_usb_deleteendpoints(dev
);
5021 destroy_workqueue(priv
->priv_wq
);
5024 free_ieee80211(dev
);
5026 RT_TRACE(COMP_ERR
, "wlan driver load failed\n");
5030 /* detach all the work and timer structure declared or inititialize
5031 * in r8192U_init function.
5033 static void rtl8192_cancel_deferred_work(struct r8192_priv
*priv
)
5036 cancel_work_sync(&priv
->reset_wq
);
5037 cancel_delayed_work(&priv
->watch_dog_wq
);
5038 cancel_delayed_work(&priv
->update_beacon_wq
);
5039 cancel_work_sync(&priv
->qos_activate
);
5043 static void rtl8192_usb_disconnect(struct usb_interface
*intf
)
5045 struct net_device
*dev
= usb_get_intfdata(intf
);
5046 struct r8192_priv
*priv
= ieee80211_priv(dev
);
5049 unregister_netdev(dev
);
5052 "=============>wlan driver to be removed\n");
5053 rtl8192_proc_remove_one(dev
);
5056 kfree(priv
->pFirmware
);
5057 priv
->pFirmware
= NULL
;
5058 rtl8192_usb_deleteendpoints(dev
);
5059 destroy_workqueue(priv
->priv_wq
);
5062 free_ieee80211(dev
);
5063 RT_TRACE(COMP_DOWN
, "wlan driver removed\n");
5066 static int __init
rtl8192_usb_module_init(void)
5070 #ifdef CONFIG_IEEE80211_DEBUG
5071 ret
= ieee80211_debug_init();
5073 pr_err("ieee80211_debug_init() failed %d\n", ret
);
5077 ret
= ieee80211_crypto_init();
5079 pr_err("ieee80211_crypto_init() failed %d\n", ret
);
5083 ret
= ieee80211_crypto_tkip_init();
5085 pr_err("ieee80211_crypto_tkip_init() failed %d\n", ret
);
5089 ret
= ieee80211_crypto_ccmp_init();
5091 pr_err("ieee80211_crypto_ccmp_init() failed %d\n", ret
);
5095 ret
= ieee80211_crypto_wep_init();
5097 pr_err("ieee80211_crypto_wep_init() failed %d\n", ret
);
5101 pr_info("\nLinux kernel driver for RTL8192 based WLAN cards\n");
5102 pr_info("Copyright (c) 2007-2008, Realsil Wlan\n");
5103 RT_TRACE(COMP_INIT
, "Initializing module");
5104 RT_TRACE(COMP_INIT
, "Wireless extensions version %d", WIRELESS_EXT
);
5105 rtl8192_proc_module_init();
5106 return usb_register(&rtl8192_usb_driver
);
5110 static void __exit
rtl8192_usb_module_exit(void)
5112 usb_deregister(&rtl8192_usb_driver
);
5114 RT_TRACE(COMP_DOWN
, "Exiting");
5118 void rtl8192_try_wake_queue(struct net_device
*dev
, int pri
)
5120 unsigned long flags
;
5122 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
5124 spin_lock_irqsave(&priv
->tx_lock
, flags
);
5125 enough_desc
= check_nic_enough_desc(dev
, pri
);
5126 spin_unlock_irqrestore(&priv
->tx_lock
, flags
);
5129 ieee80211_wake_queue(priv
->ieee80211
);
5132 void EnableHWSecurityConfig8192(struct net_device
*dev
)
5134 u8 SECR_value
= 0x0;
5135 struct r8192_priv
*priv
= (struct r8192_priv
*)ieee80211_priv(dev
);
5136 struct ieee80211_device
*ieee
= priv
->ieee80211
;
5138 SECR_value
= SCR_TxEncEnable
| SCR_RxDecEnable
;
5139 if (((KEY_TYPE_WEP40
== ieee
->pairwise_key_type
) || (KEY_TYPE_WEP104
== ieee
->pairwise_key_type
)) && (priv
->ieee80211
->auth_mode
!= 2)) {
5140 SECR_value
|= SCR_RxUseDK
;
5141 SECR_value
|= SCR_TxUseDK
;
5142 } else if ((ieee
->iw_mode
== IW_MODE_ADHOC
) && (ieee
->pairwise_key_type
& (KEY_TYPE_CCMP
| KEY_TYPE_TKIP
))) {
5143 SECR_value
|= SCR_RxUseDK
;
5144 SECR_value
|= SCR_TxUseDK
;
5146 /* add HWSec active enable here.
5147 * default using hwsec. when peer AP is in N mode only and
5148 * pairwise_key_type is none_aes(which HT_IOT_ACT_PURE_N_MODE indicates
5149 * it), use software security. when peer AP is in b,g,n mode mixed and
5150 * pairwise_key_type is none_aes, use g mode hw security.
5153 ieee
->hwsec_active
= 1;
5155 /* add hwsec_support flag to totol control hw_sec on/off */
5156 if ((ieee
->pHTInfo
->IOTAction
& HT_IOT_ACT_PURE_N_MODE
) || !hwwep
) {
5157 ieee
->hwsec_active
= 0;
5158 SECR_value
&= ~SCR_RxDecEnable
;
5160 RT_TRACE(COMP_SEC
, "%s:, hwsec:%d, pairwise_key:%d, SECR_value:%x\n",
5161 __func__
, ieee
->hwsec_active
, ieee
->pairwise_key_type
,
5163 write_nic_byte(dev
, SECR
, SECR_value
);
5167 void setKey(struct net_device
*dev
, u8 EntryNo
, u8 KeyIndex
, u16 KeyType
,
5168 u8
*MacAddr
, u8 DefaultKey
, u32
*KeyContent
)
5170 u32 TargetCommand
= 0;
5171 u32 TargetContent
= 0;
5175 if (EntryNo
>= TOTAL_CAM_ENTRY
)
5176 RT_TRACE(COMP_ERR
, "cam entry exceeds in setKey()\n");
5179 "====>to setKey(), dev:%p, EntryNo:%d, KeyIndex:%d, KeyType:%d, MacAddr%pM\n",
5180 dev
, EntryNo
, KeyIndex
, KeyType
, MacAddr
);
5183 usConfig
|= BIT(15) | (KeyType
<< 2);
5185 usConfig
|= BIT(15) | (KeyType
<< 2) | KeyIndex
;
5188 for (i
= 0; i
< CAM_CONTENT_COUNT
; i
++) {
5189 TargetCommand
= i
+ CAM_CONTENT_COUNT
* EntryNo
;
5190 TargetCommand
|= BIT(31) | BIT(16);
5192 if (i
== 0) { /* MAC|Config */
5193 TargetContent
= (u32
)(*(MacAddr
+ 0)) << 16 |
5194 (u32
)(*(MacAddr
+ 1)) << 24 |
5197 write_nic_dword(dev
, WCAMI
, TargetContent
);
5198 write_nic_dword(dev
, RWCAM
, TargetCommand
);
5199 } else if (i
== 1) { /* MAC */
5200 TargetContent
= (u32
)(*(MacAddr
+ 2)) |
5201 (u32
)(*(MacAddr
+ 3)) << 8 |
5202 (u32
)(*(MacAddr
+ 4)) << 16 |
5203 (u32
)(*(MacAddr
+ 5)) << 24;
5204 write_nic_dword(dev
, WCAMI
, TargetContent
);
5205 write_nic_dword(dev
, RWCAM
, TargetCommand
);
5208 if (KeyContent
!= NULL
) {
5209 write_nic_dword(dev
, WCAMI
, (u32
)(*(KeyContent
+ i
- 2)));
5210 write_nic_dword(dev
, RWCAM
, TargetCommand
);
5217 /***************************************************************************
5218 ------------------- module init / exit stubs ----------------
5219 ****************************************************************************/
5220 module_init(rtl8192_usb_module_init
);
5221 module_exit(rtl8192_usb_module_exit
);