1 /******************************************************************************
3 * Copyright(c) 2009-2012 Realtek Corporation. All rights reserved.
5 * This program is free software; you can redistribute it and/or modify it
6 * under the terms of version 2 of the GNU General Public License as
7 * published by the Free Software Foundation.
9 * This program is distributed in the hope that it will be useful, but WITHOUT
10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
11 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
14 * You should have received a copy of the GNU General Public License along with
15 * this program; if not, write to the Free Software Foundation, Inc.,
16 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
21 * Contact Information:
22 * wlanfae <wlanfae@realtek.com>
23 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
24 * Hsinchu 300, Taiwan.
26 *****************************************************************************/
33 #include "rtl8192c/fw_common.h"
34 #include <linux/export.h>
35 #include <linux/module.h>
37 MODULE_AUTHOR("lizhaoming <chaoming_li@realsil.com.cn>");
38 MODULE_AUTHOR("Realtek WlanFAE <wlanfae@realtek.com>");
39 MODULE_AUTHOR("Larry Finger <Larry.FInger@lwfinger.net>");
40 MODULE_LICENSE("GPL");
41 MODULE_DESCRIPTION("USB basic driver for rtlwifi");
43 #define REALTEK_USB_VENQT_READ 0xC0
44 #define REALTEK_USB_VENQT_WRITE 0x40
45 #define REALTEK_USB_VENQT_CMD_REQ 0x05
46 #define REALTEK_USB_VENQT_CMD_IDX 0x00
48 #define MAX_USBCTRL_VENDORREQ_TIMES 10
50 static void usbctrl_async_callback(struct urb
*urb
)
54 kfree(urb
->setup_packet
);
56 kfree(urb
->transfer_buffer
);
60 static int _usbctrl_vendorreq_async_write(struct usb_device
*udev
, u8 request
,
61 u16 value
, u16 index
, void *pdata
,
67 struct usb_ctrlrequest
*dr
;
69 const u16 databuf_maxlen
= REALTEK_USB_VENQT_MAX_BUF_SIZE
;
72 if (WARN_ON_ONCE(len
> databuf_maxlen
))
75 pipe
= usb_sndctrlpipe(udev
, 0); /* write_out */
76 reqtype
= REALTEK_USB_VENQT_WRITE
;
78 dr
= kzalloc(sizeof(*dr
), GFP_ATOMIC
);
82 databuf
= kzalloc(databuf_maxlen
, GFP_ATOMIC
);
88 urb
= usb_alloc_urb(0, GFP_ATOMIC
);
95 dr
->bRequestType
= reqtype
;
96 dr
->bRequest
= request
;
97 dr
->wValue
= cpu_to_le16(value
);
98 dr
->wIndex
= cpu_to_le16(index
);
99 dr
->wLength
= cpu_to_le16(len
);
100 /* data are already in little-endian order */
101 memcpy(databuf
, pdata
, len
);
102 usb_fill_control_urb(urb
, udev
, pipe
,
103 (unsigned char *)dr
, databuf
, len
,
104 usbctrl_async_callback
, NULL
);
105 rc
= usb_submit_urb(urb
, GFP_ATOMIC
);
114 static int _usbctrl_vendorreq_sync_read(struct usb_device
*udev
, u8 request
,
115 u16 value
, u16 index
, void *pdata
,
121 int vendorreq_times
= 0;
124 pipe
= usb_rcvctrlpipe(udev
, 0); /* read_in */
125 reqtype
= REALTEK_USB_VENQT_READ
;
128 status
= usb_control_msg(udev
, pipe
, request
, reqtype
, value
,
129 index
, pdata
, len
, 1000);
131 /* firmware download is checksumed, don't retry */
132 if ((value
>= FW_8192C_START_ADDRESS
&&
133 value
<= FW_8192C_END_ADDRESS
))
138 } while (++vendorreq_times
< MAX_USBCTRL_VENDORREQ_TIMES
);
140 if (status
< 0 && count
++ < 4)
141 pr_err("reg 0x%x, usbctrl_vendorreq TimeOut! status:0x%x value=0x%x\n",
142 value
, status
, *(u32
*)pdata
);
146 static u32
_usb_read_sync(struct rtl_priv
*rtlpriv
, u32 addr
, u16 len
)
148 struct device
*dev
= rtlpriv
->io
.dev
;
149 struct usb_device
*udev
= to_usb_device(dev
);
156 spin_lock_irqsave(&rtlpriv
->locks
.usb_lock
, flags
);
157 if (++rtlpriv
->usb_data_index
>= RTL_USB_MAX_RX_COUNT
)
158 rtlpriv
->usb_data_index
= 0;
159 data
= &rtlpriv
->usb_data
[rtlpriv
->usb_data_index
];
160 spin_unlock_irqrestore(&rtlpriv
->locks
.usb_lock
, flags
);
161 request
= REALTEK_USB_VENQT_CMD_REQ
;
162 index
= REALTEK_USB_VENQT_CMD_IDX
; /* n/a */
165 _usbctrl_vendorreq_sync_read(udev
, request
, wvalue
, index
, data
, len
);
166 return le32_to_cpu(*data
);
169 static u8
_usb_read8_sync(struct rtl_priv
*rtlpriv
, u32 addr
)
171 return (u8
)_usb_read_sync(rtlpriv
, addr
, 1);
174 static u16
_usb_read16_sync(struct rtl_priv
*rtlpriv
, u32 addr
)
176 return (u16
)_usb_read_sync(rtlpriv
, addr
, 2);
179 static u32
_usb_read32_sync(struct rtl_priv
*rtlpriv
, u32 addr
)
181 return _usb_read_sync(rtlpriv
, addr
, 4);
184 static void _usb_write_async(struct usb_device
*udev
, u32 addr
, u32 val
,
192 request
= REALTEK_USB_VENQT_CMD_REQ
;
193 index
= REALTEK_USB_VENQT_CMD_IDX
; /* n/a */
194 wvalue
= (u16
)(addr
&0x0000ffff);
195 data
= cpu_to_le32(val
);
196 _usbctrl_vendorreq_async_write(udev
, request
, wvalue
, index
, &data
,
200 static void _usb_write8_async(struct rtl_priv
*rtlpriv
, u32 addr
, u8 val
)
202 struct device
*dev
= rtlpriv
->io
.dev
;
204 _usb_write_async(to_usb_device(dev
), addr
, val
, 1);
207 static void _usb_write16_async(struct rtl_priv
*rtlpriv
, u32 addr
, u16 val
)
209 struct device
*dev
= rtlpriv
->io
.dev
;
211 _usb_write_async(to_usb_device(dev
), addr
, val
, 2);
214 static void _usb_write32_async(struct rtl_priv
*rtlpriv
, u32 addr
, u32 val
)
216 struct device
*dev
= rtlpriv
->io
.dev
;
218 _usb_write_async(to_usb_device(dev
), addr
, val
, 4);
221 static void _usb_writeN_sync(struct rtl_priv
*rtlpriv
, u32 addr
, void *data
,
224 struct device
*dev
= rtlpriv
->io
.dev
;
225 struct usb_device
*udev
= to_usb_device(dev
);
226 u8 request
= REALTEK_USB_VENQT_CMD_REQ
;
227 u8 reqtype
= REALTEK_USB_VENQT_WRITE
;
229 u16 index
= REALTEK_USB_VENQT_CMD_IDX
;
230 int pipe
= usb_sndctrlpipe(udev
, 0); /* write_out */
233 wvalue
= (u16
)(addr
& 0x0000ffff);
234 buffer
= kmemdup(data
, len
, GFP_ATOMIC
);
237 usb_control_msg(udev
, pipe
, request
, reqtype
, wvalue
,
238 index
, buffer
, len
, 50);
243 static void _rtl_usb_io_handler_init(struct device
*dev
,
244 struct ieee80211_hw
*hw
)
246 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
248 rtlpriv
->io
.dev
= dev
;
249 mutex_init(&rtlpriv
->io
.bb_mutex
);
250 rtlpriv
->io
.write8_async
= _usb_write8_async
;
251 rtlpriv
->io
.write16_async
= _usb_write16_async
;
252 rtlpriv
->io
.write32_async
= _usb_write32_async
;
253 rtlpriv
->io
.read8_sync
= _usb_read8_sync
;
254 rtlpriv
->io
.read16_sync
= _usb_read16_sync
;
255 rtlpriv
->io
.read32_sync
= _usb_read32_sync
;
256 rtlpriv
->io
.writeN_sync
= _usb_writeN_sync
;
259 static void _rtl_usb_io_handler_release(struct ieee80211_hw
*hw
)
261 struct rtl_priv __maybe_unused
*rtlpriv
= rtl_priv(hw
);
263 mutex_destroy(&rtlpriv
->io
.bb_mutex
);
268 * Default aggregation handler. Do nothing and just return the oldest skb.
270 static struct sk_buff
*_none_usb_tx_aggregate_hdl(struct ieee80211_hw
*hw
,
271 struct sk_buff_head
*list
)
273 return skb_dequeue(list
);
276 #define IS_HIGH_SPEED_USB(udev) \
277 ((USB_SPEED_HIGH == (udev)->speed) ? true : false)
279 static int _rtl_usb_init_tx(struct ieee80211_hw
*hw
)
282 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
283 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
285 rtlusb
->max_bulk_out_size
= IS_HIGH_SPEED_USB(rtlusb
->udev
)
286 ? USB_HIGH_SPEED_BULK_SIZE
287 : USB_FULL_SPEED_BULK_SIZE
;
289 RT_TRACE(rtlpriv
, COMP_INIT
, DBG_DMESG
, "USB Max Bulk-out Size=%d\n",
290 rtlusb
->max_bulk_out_size
);
292 for (i
= 0; i
< __RTL_TXQ_NUM
; i
++) {
293 u32 ep_num
= rtlusb
->ep_map
.ep_mapping
[i
];
295 RT_TRACE(rtlpriv
, COMP_INIT
, DBG_DMESG
,
296 "Invalid endpoint map setting!\n");
301 rtlusb
->usb_tx_post_hdl
=
302 rtlpriv
->cfg
->usb_interface_cfg
->usb_tx_post_hdl
;
303 rtlusb
->usb_tx_cleanup
=
304 rtlpriv
->cfg
->usb_interface_cfg
->usb_tx_cleanup
;
305 rtlusb
->usb_tx_aggregate_hdl
=
306 (rtlpriv
->cfg
->usb_interface_cfg
->usb_tx_aggregate_hdl
)
307 ? rtlpriv
->cfg
->usb_interface_cfg
->usb_tx_aggregate_hdl
308 : &_none_usb_tx_aggregate_hdl
;
310 init_usb_anchor(&rtlusb
->tx_submitted
);
311 for (i
= 0; i
< RTL_USB_MAX_EP_NUM
; i
++) {
312 skb_queue_head_init(&rtlusb
->tx_skb_queue
[i
]);
313 init_usb_anchor(&rtlusb
->tx_pending
[i
]);
318 static void _rtl_rx_work(unsigned long param
);
320 static int _rtl_usb_init_rx(struct ieee80211_hw
*hw
)
322 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
323 struct rtl_usb_priv
*usb_priv
= rtl_usbpriv(hw
);
324 struct rtl_usb
*rtlusb
= rtl_usbdev(usb_priv
);
326 rtlusb
->rx_max_size
= rtlpriv
->cfg
->usb_interface_cfg
->rx_max_size
;
327 rtlusb
->rx_urb_num
= rtlpriv
->cfg
->usb_interface_cfg
->rx_urb_num
;
328 rtlusb
->in_ep
= rtlpriv
->cfg
->usb_interface_cfg
->in_ep_num
;
329 rtlusb
->usb_rx_hdl
= rtlpriv
->cfg
->usb_interface_cfg
->usb_rx_hdl
;
330 rtlusb
->usb_rx_segregate_hdl
=
331 rtlpriv
->cfg
->usb_interface_cfg
->usb_rx_segregate_hdl
;
333 pr_info("rx_max_size %d, rx_urb_num %d, in_ep %d\n",
334 rtlusb
->rx_max_size
, rtlusb
->rx_urb_num
, rtlusb
->in_ep
);
335 init_usb_anchor(&rtlusb
->rx_submitted
);
336 init_usb_anchor(&rtlusb
->rx_cleanup_urbs
);
338 skb_queue_head_init(&rtlusb
->rx_queue
);
339 rtlusb
->rx_work_tasklet
.func
= _rtl_rx_work
;
340 rtlusb
->rx_work_tasklet
.data
= (unsigned long)rtlusb
;
345 static int _rtl_usb_init(struct ieee80211_hw
*hw
)
347 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
348 struct rtl_usb_priv
*usb_priv
= rtl_usbpriv(hw
);
349 struct rtl_usb
*rtlusb
= rtl_usbdev(usb_priv
);
352 struct usb_interface
*usb_intf
= rtlusb
->intf
;
353 u8 epnums
= usb_intf
->cur_altsetting
->desc
.bNumEndpoints
;
355 rtlusb
->out_ep_nums
= rtlusb
->in_ep_nums
= 0;
356 for (epidx
= 0; epidx
< epnums
; epidx
++) {
357 struct usb_endpoint_descriptor
*pep_desc
;
358 pep_desc
= &usb_intf
->cur_altsetting
->endpoint
[epidx
].desc
;
360 if (usb_endpoint_dir_in(pep_desc
))
361 rtlusb
->in_ep_nums
++;
362 else if (usb_endpoint_dir_out(pep_desc
))
363 rtlusb
->out_ep_nums
++;
365 RT_TRACE(rtlpriv
, COMP_INIT
, DBG_DMESG
,
366 "USB EP(0x%02x), MaxPacketSize=%d, Interval=%d\n",
367 pep_desc
->bEndpointAddress
, pep_desc
->wMaxPacketSize
,
368 pep_desc
->bInterval
);
370 if (rtlusb
->in_ep_nums
< rtlpriv
->cfg
->usb_interface_cfg
->in_ep_num
) {
371 pr_err("Too few input end points found\n");
374 if (rtlusb
->out_ep_nums
== 0) {
375 pr_err("No output end points found\n");
378 /* usb endpoint mapping */
379 err
= rtlpriv
->cfg
->usb_interface_cfg
->usb_endpoint_mapping(hw
);
380 rtlusb
->usb_mq_to_hwq
= rtlpriv
->cfg
->usb_interface_cfg
->usb_mq_to_hwq
;
381 _rtl_usb_init_tx(hw
);
382 _rtl_usb_init_rx(hw
);
386 static void rtl_usb_init_sw(struct ieee80211_hw
*hw
)
388 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
389 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
390 struct rtl_ps_ctl
*ppsc
= rtl_psc(rtl_priv(hw
));
391 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
394 ppsc
->inactiveps
= false;
395 ppsc
->leisure_ps
= false;
396 ppsc
->fwctrl_lps
= false;
397 ppsc
->reg_fwctrl_lps
= 3;
398 ppsc
->reg_max_lps_awakeintvl
= 5;
399 ppsc
->fwctrl_psmode
= FW_PS_DTIM_MODE
;
402 mac
->beacon_interval
= 100;
405 mac
->min_space_cfg
= 0;
406 mac
->max_mss_density
= 0;
408 /* set sane AMPDU defaults */
409 mac
->current_ampdu_density
= 7;
410 mac
->current_ampdu_factor
= 3;
413 rtlusb
->acm_method
= EACMWAY2_SW
;
416 /* HIMR - turn all on */
417 rtlusb
->irq_mask
[0] = 0xFFFFFFFF;
418 /* HIMR_EX - turn all on */
419 rtlusb
->irq_mask
[1] = 0xFFFFFFFF;
420 rtlusb
->disableHWSM
= true;
423 static void _rtl_rx_completed(struct urb
*urb
);
425 static int _rtl_prep_rx_urb(struct ieee80211_hw
*hw
, struct rtl_usb
*rtlusb
,
426 struct urb
*urb
, gfp_t gfp_mask
)
428 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
431 buf
= usb_alloc_coherent(rtlusb
->udev
, rtlusb
->rx_max_size
, gfp_mask
,
434 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
435 "Failed to usb_alloc_coherent!!\n");
439 usb_fill_bulk_urb(urb
, rtlusb
->udev
,
440 usb_rcvbulkpipe(rtlusb
->udev
, rtlusb
->in_ep
),
441 buf
, rtlusb
->rx_max_size
, _rtl_rx_completed
, rtlusb
);
442 urb
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
447 static void _rtl_usb_rx_process_agg(struct ieee80211_hw
*hw
,
450 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
451 u8
*rxdesc
= skb
->data
;
452 struct ieee80211_hdr
*hdr
;
453 bool unicast
= false;
455 struct ieee80211_rx_status rx_status
= {0};
456 struct rtl_stats stats
= {
461 skb_pull(skb
, RTL_RX_DESC_SIZE
);
462 rtlpriv
->cfg
->ops
->query_rx_desc(hw
, &stats
, &rx_status
, rxdesc
, skb
);
463 skb_pull(skb
, (stats
.rx_drvinfo_size
+ stats
.rx_bufshift
));
464 hdr
= (struct ieee80211_hdr
*)(skb
->data
);
465 fc
= hdr
->frame_control
;
467 memcpy(IEEE80211_SKB_RXCB(skb
), &rx_status
, sizeof(rx_status
));
469 if (is_broadcast_ether_addr(hdr
->addr1
)) {
471 } else if (is_multicast_ether_addr(hdr
->addr1
)) {
475 rtlpriv
->stats
.rxbytesunicast
+= skb
->len
;
478 if (ieee80211_is_data(fc
)) {
479 rtlpriv
->cfg
->ops
->led_control(hw
, LED_CTL_RX
);
482 rtlpriv
->link_info
.num_rx_inperiod
++;
484 /* static bcn for roaming */
485 rtl_beacon_statistic(hw
, skb
);
489 static void _rtl_usb_rx_process_noagg(struct ieee80211_hw
*hw
,
492 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
493 u8
*rxdesc
= skb
->data
;
494 struct ieee80211_hdr
*hdr
;
495 bool unicast
= false;
497 struct ieee80211_rx_status rx_status
= {0};
498 struct rtl_stats stats
= {
503 skb_pull(skb
, RTL_RX_DESC_SIZE
);
504 rtlpriv
->cfg
->ops
->query_rx_desc(hw
, &stats
, &rx_status
, rxdesc
, skb
);
505 skb_pull(skb
, (stats
.rx_drvinfo_size
+ stats
.rx_bufshift
));
506 hdr
= (struct ieee80211_hdr
*)(skb
->data
);
507 fc
= hdr
->frame_control
;
509 memcpy(IEEE80211_SKB_RXCB(skb
), &rx_status
, sizeof(rx_status
));
511 if (is_broadcast_ether_addr(hdr
->addr1
)) {
513 } else if (is_multicast_ether_addr(hdr
->addr1
)) {
517 rtlpriv
->stats
.rxbytesunicast
+= skb
->len
;
520 if (ieee80211_is_data(fc
)) {
521 rtlpriv
->cfg
->ops
->led_control(hw
, LED_CTL_RX
);
524 rtlpriv
->link_info
.num_rx_inperiod
++;
527 /* static bcn for roaming */
528 rtl_beacon_statistic(hw
, skb
);
530 if (likely(rtl_action_proc(hw
, skb
, false)))
531 ieee80211_rx(hw
, skb
);
533 dev_kfree_skb_any(skb
);
535 dev_kfree_skb_any(skb
);
539 static void _rtl_rx_pre_process(struct ieee80211_hw
*hw
, struct sk_buff
*skb
)
541 struct sk_buff
*_skb
;
542 struct sk_buff_head rx_queue
;
543 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
545 skb_queue_head_init(&rx_queue
);
546 if (rtlusb
->usb_rx_segregate_hdl
)
547 rtlusb
->usb_rx_segregate_hdl(hw
, skb
, &rx_queue
);
548 WARN_ON(skb_queue_empty(&rx_queue
));
549 while (!skb_queue_empty(&rx_queue
)) {
550 _skb
= skb_dequeue(&rx_queue
);
551 _rtl_usb_rx_process_agg(hw
, _skb
);
552 ieee80211_rx(hw
, _skb
);
556 #define __RX_SKB_MAX_QUEUED 64
558 static void _rtl_rx_work(unsigned long param
)
560 struct rtl_usb
*rtlusb
= (struct rtl_usb
*)param
;
561 struct ieee80211_hw
*hw
= usb_get_intfdata(rtlusb
->intf
);
564 while ((skb
= skb_dequeue(&rtlusb
->rx_queue
))) {
565 if (unlikely(IS_USB_STOP(rtlusb
))) {
566 dev_kfree_skb_any(skb
);
570 if (likely(!rtlusb
->usb_rx_segregate_hdl
)) {
571 _rtl_usb_rx_process_noagg(hw
, skb
);
574 _rtl_rx_pre_process(hw
, skb
);
575 pr_err("rx agg not supported\n");
580 static unsigned int _rtl_rx_get_padding(struct ieee80211_hdr
*hdr
,
583 #if NET_IP_ALIGN != 0
584 unsigned int padding
= 0;
587 /* make function no-op when possible */
588 if (NET_IP_ALIGN
== 0 || len
< sizeof(*hdr
))
591 #if NET_IP_ALIGN != 0
592 /* alignment calculation as in lbtf_rx() / carl9170_rx_copy_data() */
593 /* TODO: deduplicate common code, define helper function instead? */
595 if (ieee80211_is_data_qos(hdr
->frame_control
)) {
596 u8
*qc
= ieee80211_get_qos_ctl(hdr
);
598 padding
^= NET_IP_ALIGN
;
600 /* Input might be invalid, avoid accessing memory outside
603 if ((unsigned long)qc
- (unsigned long)hdr
< len
&&
604 *qc
& IEEE80211_QOS_CTL_A_MSDU_PRESENT
)
605 padding
^= NET_IP_ALIGN
;
608 if (ieee80211_has_a4(hdr
->frame_control
))
609 padding
^= NET_IP_ALIGN
;
615 #define __RADIO_TAP_SIZE_RSV 32
617 static void _rtl_rx_completed(struct urb
*_urb
)
619 struct rtl_usb
*rtlusb
= (struct rtl_usb
*)_urb
->context
;
620 struct ieee80211_hw
*hw
= usb_get_intfdata(rtlusb
->intf
);
621 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
624 if (unlikely(IS_USB_STOP(rtlusb
)))
627 if (likely(0 == _urb
->status
)) {
628 unsigned int padding
;
631 unsigned int size
= _urb
->actual_length
;
632 struct ieee80211_hdr
*hdr
;
634 if (size
< RTL_RX_DESC_SIZE
+ sizeof(struct ieee80211_hdr
)) {
635 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
636 "Too short packet from bulk IN! (len: %d)\n",
641 qlen
= skb_queue_len(&rtlusb
->rx_queue
);
642 if (qlen
>= __RX_SKB_MAX_QUEUED
) {
643 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
644 "Pending RX skbuff queue full! (qlen: %d)\n",
649 hdr
= (void *)(_urb
->transfer_buffer
+ RTL_RX_DESC_SIZE
);
650 padding
= _rtl_rx_get_padding(hdr
, size
- RTL_RX_DESC_SIZE
);
652 skb
= dev_alloc_skb(size
+ __RADIO_TAP_SIZE_RSV
+ padding
);
654 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
655 "Can't allocate skb for bulk IN!\n");
659 _rtl_install_trx_info(rtlusb
, skb
, rtlusb
->in_ep
);
661 /* Make sure the payload data is 4 byte aligned. */
662 skb_reserve(skb
, padding
);
664 /* reserve some space for mac80211's radiotap */
665 skb_reserve(skb
, __RADIO_TAP_SIZE_RSV
);
667 memcpy(skb_put(skb
, size
), _urb
->transfer_buffer
, size
);
669 skb_queue_tail(&rtlusb
->rx_queue
, skb
);
670 tasklet_schedule(&rtlusb
->rx_work_tasklet
);
675 switch (_urb
->status
) {
687 usb_anchor_urb(_urb
, &rtlusb
->rx_submitted
);
688 err
= usb_submit_urb(_urb
, GFP_ATOMIC
);
690 usb_unanchor_urb(_urb
);
696 /* On some architectures, usb_free_coherent must not be called from
697 * hardirq context. Queue urb to cleanup list.
699 usb_anchor_urb(_urb
, &rtlusb
->rx_cleanup_urbs
);
702 #undef __RADIO_TAP_SIZE_RSV
704 static void _rtl_usb_cleanup_rx(struct ieee80211_hw
*hw
)
706 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
707 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
710 usb_kill_anchored_urbs(&rtlusb
->rx_submitted
);
712 tasklet_kill(&rtlusb
->rx_work_tasklet
);
713 cancel_work_sync(&rtlpriv
->works
.lps_change_work
);
715 flush_workqueue(rtlpriv
->works
.rtl_wq
);
716 destroy_workqueue(rtlpriv
->works
.rtl_wq
);
718 skb_queue_purge(&rtlusb
->rx_queue
);
720 while ((urb
= usb_get_from_anchor(&rtlusb
->rx_cleanup_urbs
))) {
721 usb_free_coherent(urb
->dev
, urb
->transfer_buffer_length
,
722 urb
->transfer_buffer
, urb
->transfer_dma
);
727 static int _rtl_usb_receive(struct ieee80211_hw
*hw
)
732 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
733 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
735 WARN_ON(0 == rtlusb
->rx_urb_num
);
736 /* 1600 == 1514 + max WLAN header + rtk info */
737 WARN_ON(rtlusb
->rx_max_size
< 1600);
739 for (i
= 0; i
< rtlusb
->rx_urb_num
; i
++) {
741 urb
= usb_alloc_urb(0, GFP_KERNEL
);
743 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
744 "Failed to alloc URB!!\n");
748 err
= _rtl_prep_rx_urb(hw
, rtlusb
, urb
, GFP_KERNEL
);
750 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
751 "Failed to prep_rx_urb!!\n");
756 usb_anchor_urb(urb
, &rtlusb
->rx_submitted
);
757 err
= usb_submit_urb(urb
, GFP_KERNEL
);
765 usb_kill_anchored_urbs(&rtlusb
->rx_submitted
);
766 _rtl_usb_cleanup_rx(hw
);
770 static int rtl_usb_start(struct ieee80211_hw
*hw
)
773 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
774 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
775 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
777 err
= rtlpriv
->cfg
->ops
->hw_init(hw
);
779 rtl_init_rx_config(hw
);
781 /* Enable software */
782 SET_USB_START(rtlusb
);
783 /* should after adapter start and interrupt enable. */
784 set_hal_start(rtlhal
);
787 err
= _rtl_usb_receive(hw
);
797 /*======================= tx =========================================*/
798 static void rtl_usb_cleanup(struct ieee80211_hw
*hw
)
801 struct sk_buff
*_skb
;
802 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
803 struct ieee80211_tx_info
*txinfo
;
805 /* clean up rx stuff. */
806 _rtl_usb_cleanup_rx(hw
);
808 /* clean up tx stuff */
809 for (i
= 0; i
< RTL_USB_MAX_EP_NUM
; i
++) {
810 while ((_skb
= skb_dequeue(&rtlusb
->tx_skb_queue
[i
]))) {
811 rtlusb
->usb_tx_cleanup(hw
, _skb
);
812 txinfo
= IEEE80211_SKB_CB(_skb
);
813 ieee80211_tx_info_clear_status(txinfo
);
814 txinfo
->flags
|= IEEE80211_TX_STAT_ACK
;
815 ieee80211_tx_status_irqsafe(hw
, _skb
);
817 usb_kill_anchored_urbs(&rtlusb
->tx_pending
[i
]);
819 usb_kill_anchored_urbs(&rtlusb
->tx_submitted
);
824 * We may add some struct into struct rtl_usb later. Do deinit here.
827 static void rtl_usb_deinit(struct ieee80211_hw
*hw
)
832 static void rtl_usb_stop(struct ieee80211_hw
*hw
)
834 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
835 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
836 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
838 /* should after adapter start and interrupt enable. */
839 set_hal_stop(rtlhal
);
840 cancel_work_sync(&rtlpriv
->works
.fill_h2c_cmd
);
841 /* Enable software */
842 SET_USB_STOP(rtlusb
);
843 rtlpriv
->cfg
->ops
->hw_disable(hw
);
846 static void _rtl_submit_tx_urb(struct ieee80211_hw
*hw
, struct urb
*_urb
)
849 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
850 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
852 usb_anchor_urb(_urb
, &rtlusb
->tx_submitted
);
853 err
= usb_submit_urb(_urb
, GFP_ATOMIC
);
857 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
858 "Failed to submit urb\n");
859 usb_unanchor_urb(_urb
);
860 skb
= (struct sk_buff
*)_urb
->context
;
866 static int _usb_tx_post(struct ieee80211_hw
*hw
, struct urb
*urb
,
869 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
870 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
871 struct ieee80211_tx_info
*txinfo
;
873 rtlusb
->usb_tx_post_hdl(hw
, urb
, skb
);
874 skb_pull(skb
, RTL_TX_HEADER_SIZE
);
875 txinfo
= IEEE80211_SKB_CB(skb
);
876 ieee80211_tx_info_clear_status(txinfo
);
877 txinfo
->flags
|= IEEE80211_TX_STAT_ACK
;
880 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
881 "Urb has error status 0x%X\n", urb
->status
);
884 /* TODO: statistics */
886 ieee80211_tx_status_irqsafe(hw
, skb
);
890 static void _rtl_tx_complete(struct urb
*urb
)
892 struct sk_buff
*skb
= (struct sk_buff
*)urb
->context
;
893 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
894 struct rtl_usb
*rtlusb
= (struct rtl_usb
*)info
->rate_driver_data
[0];
895 struct ieee80211_hw
*hw
= usb_get_intfdata(rtlusb
->intf
);
898 if (unlikely(IS_USB_STOP(rtlusb
)))
900 err
= _usb_tx_post(hw
, urb
, skb
);
902 /* Ignore error and keep issuiing other urbs */
907 static struct urb
*_rtl_usb_tx_urb_setup(struct ieee80211_hw
*hw
,
908 struct sk_buff
*skb
, u32 ep_num
)
910 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
911 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
914 WARN_ON(NULL
== skb
);
915 _urb
= usb_alloc_urb(0, GFP_ATOMIC
);
917 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
918 "Can't allocate URB for bulk out!\n");
922 _rtl_install_trx_info(rtlusb
, skb
, ep_num
);
923 usb_fill_bulk_urb(_urb
, rtlusb
->udev
, usb_sndbulkpipe(rtlusb
->udev
,
924 ep_num
), skb
->data
, skb
->len
, _rtl_tx_complete
, skb
);
925 _urb
->transfer_flags
|= URB_ZERO_PACKET
;
929 static void _rtl_usb_transmit(struct ieee80211_hw
*hw
, struct sk_buff
*skb
,
932 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
933 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
935 struct urb
*_urb
= NULL
;
936 struct sk_buff
*_skb
= NULL
;
938 WARN_ON(NULL
== rtlusb
->usb_tx_aggregate_hdl
);
939 if (unlikely(IS_USB_STOP(rtlusb
))) {
940 RT_TRACE(rtlpriv
, COMP_USB
, DBG_EMERG
,
941 "USB device is stopping...\n");
945 ep_num
= rtlusb
->ep_map
.ep_mapping
[qnum
];
947 _urb
= _rtl_usb_tx_urb_setup(hw
, _skb
, ep_num
);
948 if (unlikely(!_urb
)) {
949 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
,
950 "Can't allocate urb. Drop skb!\n");
954 _rtl_submit_tx_urb(hw
, _urb
);
957 static void _rtl_usb_tx_preprocess(struct ieee80211_hw
*hw
,
958 struct ieee80211_sta
*sta
,
962 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
963 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
964 struct ieee80211_tx_info
*info
= IEEE80211_SKB_CB(skb
);
965 struct rtl_tx_desc
*pdesc
= NULL
;
966 struct rtl_tcb_desc tcb_desc
;
967 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)(skb
->data
);
968 __le16 fc
= hdr
->frame_control
;
969 u8
*pda_addr
= hdr
->addr1
;
975 memset(&tcb_desc
, 0, sizeof(struct rtl_tcb_desc
));
976 if (ieee80211_is_auth(fc
)) {
977 RT_TRACE(rtlpriv
, COMP_SEND
, DBG_DMESG
, "MAC80211_LINKING\n");
981 if (rtlpriv
->psc
.sw_ps_enabled
) {
982 if (ieee80211_is_data(fc
) && !ieee80211_is_nullfunc(fc
) &&
983 !ieee80211_has_pm(fc
))
984 hdr
->frame_control
|= cpu_to_le16(IEEE80211_FCTL_PM
);
987 rtl_action_proc(hw
, skb
, true);
988 if (is_multicast_ether_addr(pda_addr
))
989 rtlpriv
->stats
.txbytesmulticast
+= skb
->len
;
990 else if (is_broadcast_ether_addr(pda_addr
))
991 rtlpriv
->stats
.txbytesbroadcast
+= skb
->len
;
993 rtlpriv
->stats
.txbytesunicast
+= skb
->len
;
994 if (ieee80211_is_data_qos(fc
)) {
995 qc
= ieee80211_get_qos_ctl(hdr
);
996 tid
= qc
[0] & IEEE80211_QOS_CTL_TID_MASK
;
997 seq_number
= (le16_to_cpu(hdr
->seq_ctrl
) &
998 IEEE80211_SCTL_SEQ
) >> 4;
1002 rtlpriv
->cfg
->ops
->fill_tx_desc(hw
, hdr
, (u8
*)pdesc
, NULL
, info
, sta
, skb
,
1003 hw_queue
, &tcb_desc
);
1004 if (!ieee80211_has_morefrags(hdr
->frame_control
)) {
1006 mac
->tids
[tid
].seq_number
= seq_number
;
1008 if (ieee80211_is_data(fc
))
1009 rtlpriv
->cfg
->ops
->led_control(hw
, LED_CTL_TX
);
1012 static int rtl_usb_tx(struct ieee80211_hw
*hw
,
1013 struct ieee80211_sta
*sta
,
1014 struct sk_buff
*skb
,
1015 struct rtl_tcb_desc
*dummy
)
1017 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
1018 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
1019 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)(skb
->data
);
1020 __le16 fc
= hdr
->frame_control
;
1023 if (unlikely(is_hal_stop(rtlhal
)))
1025 hw_queue
= rtlusb
->usb_mq_to_hwq(fc
, skb_get_queue_mapping(skb
));
1026 _rtl_usb_tx_preprocess(hw
, sta
, skb
, hw_queue
);
1027 _rtl_usb_transmit(hw
, skb
, hw_queue
);
1028 return NETDEV_TX_OK
;
1031 dev_kfree_skb_any(skb
);
1032 return NETDEV_TX_OK
;
1035 static bool rtl_usb_tx_chk_waitq_insert(struct ieee80211_hw
*hw
,
1036 struct ieee80211_sta
*sta
,
1037 struct sk_buff
*skb
)
1042 static void rtl_fill_h2c_cmd_work_callback(struct work_struct
*work
)
1044 struct rtl_works
*rtlworks
=
1045 container_of(work
, struct rtl_works
, fill_h2c_cmd
);
1046 struct ieee80211_hw
*hw
= rtlworks
->hw
;
1047 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1049 rtlpriv
->cfg
->ops
->fill_h2c_cmd(hw
, H2C_RA_MASK
, 5, rtlpriv
->rate_mask
);
1052 static struct rtl_intf_ops rtl_usb_ops
= {
1053 .adapter_start
= rtl_usb_start
,
1054 .adapter_stop
= rtl_usb_stop
,
1055 .adapter_tx
= rtl_usb_tx
,
1056 .waitq_insert
= rtl_usb_tx_chk_waitq_insert
,
1059 int rtl_usb_probe(struct usb_interface
*intf
,
1060 const struct usb_device_id
*id
,
1061 struct rtl_hal_cfg
*rtl_hal_cfg
)
1064 struct ieee80211_hw
*hw
= NULL
;
1065 struct rtl_priv
*rtlpriv
= NULL
;
1066 struct usb_device
*udev
;
1067 struct rtl_usb_priv
*usb_priv
;
1069 hw
= ieee80211_alloc_hw(sizeof(struct rtl_priv
) +
1070 sizeof(struct rtl_usb_priv
), &rtl_ops
);
1072 RT_ASSERT(false, "ieee80211 alloc failed\n");
1076 rtlpriv
->usb_data
= kzalloc(RTL_USB_MAX_RX_COUNT
* sizeof(u32
),
1078 if (!rtlpriv
->usb_data
)
1081 /* this spin lock must be initialized early */
1082 spin_lock_init(&rtlpriv
->locks
.usb_lock
);
1083 INIT_WORK(&rtlpriv
->works
.fill_h2c_cmd
,
1084 rtl_fill_h2c_cmd_work_callback
);
1085 INIT_WORK(&rtlpriv
->works
.lps_change_work
,
1086 rtl_lps_change_work_callback
);
1088 rtlpriv
->usb_data_index
= 0;
1089 init_completion(&rtlpriv
->firmware_loading_complete
);
1090 SET_IEEE80211_DEV(hw
, &intf
->dev
);
1091 udev
= interface_to_usbdev(intf
);
1093 usb_priv
= rtl_usbpriv(hw
);
1094 memset(usb_priv
, 0, sizeof(*usb_priv
));
1095 usb_priv
->dev
.intf
= intf
;
1096 usb_priv
->dev
.udev
= udev
;
1097 usb_set_intfdata(intf
, hw
);
1098 /* init cfg & intf_ops */
1099 rtlpriv
->rtlhal
.interface
= INTF_USB
;
1100 rtlpriv
->cfg
= rtl_hal_cfg
;
1101 rtlpriv
->intf_ops
= &rtl_usb_ops
;
1102 rtl_dbgp_flag_init(hw
);
1103 /* Init IO handler */
1104 _rtl_usb_io_handler_init(&udev
->dev
, hw
);
1105 rtlpriv
->cfg
->ops
->read_chip_version(hw
);
1106 /*like read eeprom and so on */
1107 rtlpriv
->cfg
->ops
->read_eeprom_info(hw
);
1108 err
= _rtl_usb_init(hw
);
1111 rtl_usb_init_sw(hw
);
1112 /* Init mac80211 sw */
1113 err
= rtl_init_core(hw
);
1115 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
,
1116 "Can't allocate sw for mac80211\n");
1119 if (rtlpriv
->cfg
->ops
->init_sw_vars(hw
)) {
1120 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
, "Can't init_sw_vars\n");
1123 rtlpriv
->cfg
->ops
->init_sw_leds(hw
);
1125 err
= ieee80211_register_hw(hw
);
1127 RT_TRACE(rtlpriv
, COMP_ERR
, DBG_EMERG
,
1128 "Can't register mac80211 hw.\n");
1132 rtlpriv
->mac80211
.mac80211_registered
= 1;
1134 set_bit(RTL_STATUS_INTERFACE_START
, &rtlpriv
->status
);
1138 rtl_deinit_core(hw
);
1139 _rtl_usb_io_handler_release(hw
);
1141 complete(&rtlpriv
->firmware_loading_complete
);
1144 EXPORT_SYMBOL(rtl_usb_probe
);
1146 void rtl_usb_disconnect(struct usb_interface
*intf
)
1148 struct ieee80211_hw
*hw
= usb_get_intfdata(intf
);
1149 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
1150 struct rtl_mac
*rtlmac
= rtl_mac(rtl_priv(hw
));
1151 struct rtl_usb
*rtlusb
= rtl_usbdev(rtl_usbpriv(hw
));
1153 if (unlikely(!rtlpriv
))
1155 /* just in case driver is removed before firmware callback */
1156 wait_for_completion(&rtlpriv
->firmware_loading_complete
);
1157 clear_bit(RTL_STATUS_INTERFACE_START
, &rtlpriv
->status
);
1158 /*ieee80211_unregister_hw will call ops_stop */
1159 if (rtlmac
->mac80211_registered
== 1) {
1160 ieee80211_unregister_hw(hw
);
1161 rtlmac
->mac80211_registered
= 0;
1163 rtl_deinit_deferred_work(hw
);
1164 rtlpriv
->intf_ops
->adapter_stop(hw
);
1167 /* rtl_deinit_rfkill(hw); */
1169 rtl_deinit_core(hw
);
1170 kfree(rtlpriv
->usb_data
);
1171 rtlpriv
->cfg
->ops
->deinit_sw_leds(hw
);
1172 rtlpriv
->cfg
->ops
->deinit_sw_vars(hw
);
1173 _rtl_usb_io_handler_release(hw
);
1174 usb_put_dev(rtlusb
->udev
);
1175 usb_set_intfdata(intf
, NULL
);
1176 ieee80211_free_hw(hw
);
1178 EXPORT_SYMBOL(rtl_usb_disconnect
);
1180 int rtl_usb_suspend(struct usb_interface
*pusb_intf
, pm_message_t message
)
1184 EXPORT_SYMBOL(rtl_usb_suspend
);
1186 int rtl_usb_resume(struct usb_interface
*pusb_intf
)
1190 EXPORT_SYMBOL(rtl_usb_resume
);