1/****************************************************************************** 2 * 3 * Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved. 4 * 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. 8 * 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 12 * more details. 13 * 14 ******************************************************************************/ 15#define _XMIT_OSDEP_C_ 16 17#include <osdep_service.h> 18#include <drv_types.h> 19 20#include <linux/if_ether.h> 21#include <linux/ip.h> 22#include <wifi.h> 23#include <mlme_osdep.h> 24#include <xmit_osdep.h> 25#include <osdep_intf.h> 26 27int rtw_os_xmit_resource_alloc23a(struct rtw_adapter *padapter, 28 struct xmit_buf *pxmitbuf, u32 alloc_sz) 29{ 30 int i; 31 32 pxmitbuf->pallocated_buf = kzalloc(alloc_sz, GFP_KERNEL); 33 if (pxmitbuf->pallocated_buf == NULL) 34 return _FAIL; 35 36 pxmitbuf->pbuf = PTR_ALIGN(pxmitbuf->pallocated_buf, XMITBUF_ALIGN_SZ); 37 38 for (i = 0; i < 8; i++) { 39 pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL); 40 if (pxmitbuf->pxmit_urb[i] == NULL) { 41 DBG_8723A("pxmitbuf->pxmit_urb[i]==NULL"); 42 return _FAIL; 43 } 44 } 45 return _SUCCESS; 46} 47 48void rtw_os_xmit_resource_free23a(struct rtw_adapter *padapter, 49 struct xmit_buf *pxmitbuf) 50{ 51 int i; 52 53 for (i = 0; i < 8; i++) 54 usb_free_urb(pxmitbuf->pxmit_urb[i]); 55 kfree(pxmitbuf->pallocated_buf); 56} 57 58#define WMM_XMIT_THRESHOLD (NR_XMITFRAME*2/5) 59 60void rtw_os_pkt_complete23a(struct rtw_adapter *padapter, struct sk_buff *pkt) 61{ 62 struct xmit_priv *pxmitpriv = &padapter->xmitpriv; 63 u16 queue; 64 65 queue = skb_get_queue_mapping(pkt); 66 if (padapter->registrypriv.wifi_spec) { 67 if (__netif_subqueue_stopped(padapter->pnetdev, queue) && 68 (pxmitpriv->hwxmits[queue].accnt < WMM_XMIT_THRESHOLD)) 69 netif_wake_subqueue(padapter->pnetdev, queue); 70 } else { 71 if (__netif_subqueue_stopped(padapter->pnetdev, queue)) 72 netif_wake_subqueue(padapter->pnetdev, queue); 73 } 74 dev_kfree_skb_any(pkt); 75} 76 77void rtw_os_xmit_complete23a(struct rtw_adapter *padapter, 78 struct xmit_frame *pxframe) 79{ 80 if (pxframe->pkt) 81 rtw_os_pkt_complete23a(padapter, pxframe->pkt); 82 83 pxframe->pkt = NULL; 84} 85 86void rtw_os_xmit_schedule23a(struct rtw_adapter *padapter) 87{ 88 struct xmit_priv *pxmitpriv; 89 90 if (!padapter) 91 return; 92 pxmitpriv = &padapter->xmitpriv; 93 94 spin_lock_bh(&pxmitpriv->lock); 95 96 if (rtw_txframes_pending23a(padapter)) 97 tasklet_hi_schedule(&pxmitpriv->xmit_tasklet); 98 spin_unlock_bh(&pxmitpriv->lock); 99} 100 101static void rtw_check_xmit_resource(struct rtw_adapter *padapter, 102 struct sk_buff *pkt) 103{ 104 struct xmit_priv *pxmitpriv = &padapter->xmitpriv; 105 u16 queue; 106 107 queue = skb_get_queue_mapping(pkt); 108 if (padapter->registrypriv.wifi_spec) { 109 /* No free space for Tx, tx_worker is too slow */ 110 if (pxmitpriv->hwxmits[queue].accnt > WMM_XMIT_THRESHOLD) 111 netif_stop_subqueue(padapter->pnetdev, queue); 112 } else { 113 if (pxmitpriv->free_xmitframe_cnt <= 4) { 114 if (!netif_tx_queue_stopped(netdev_get_tx_queue(padapter->pnetdev, queue))) 115 netif_stop_subqueue(padapter->pnetdev, queue); 116 } 117 } 118} 119 120int rtw_xmit23a_entry23a(struct sk_buff *skb, struct net_device *pnetdev) 121{ 122 struct rtw_adapter *padapter = netdev_priv(pnetdev); 123 struct xmit_priv *pxmitpriv = &padapter->xmitpriv; 124 int res = 0; 125 126 RT_TRACE(_module_rtl871x_mlme_c_, _drv_info_, ("+xmit_enry\n")); 127 128 if (!rtw_if_up23a(padapter)) { 129 RT_TRACE(_module_xmit_osdep_c_, _drv_err_, 130 ("rtw_xmit23a_entry23a: rtw_if_up23a fail\n")); 131 goto drop_packet; 132 } 133 134 rtw_check_xmit_resource(padapter, skb); 135 136 res = rtw_xmit23a(padapter, skb); 137 if (res < 0) 138 goto drop_packet; 139 140 pxmitpriv->tx_pkts++; 141 RT_TRACE(_module_xmit_osdep_c_, _drv_info_, 142 ("rtw_xmit23a_entry23a: tx_pkts=%d\n", 143 (u32)pxmitpriv->tx_pkts)); 144 goto exit; 145 146drop_packet: 147 pxmitpriv->tx_drop++; 148 dev_kfree_skb_any(skb); 149 RT_TRACE(_module_xmit_osdep_c_, _drv_notice_, 150 ("rtw_xmit23a_entry23a: drop, tx_drop=%d\n", 151 (u32)pxmitpriv->tx_drop)); 152exit: 153 return 0; 154} 155