drivers/staging/rtl8712/xmit_linux.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /******************************************************************************
   3  * xmit_linux.c
   4  *
   5  * Copyright(c) 2007 - 2010 Realtek Corporation. All rights reserved.
   6  * Linux device driver for RTL8192SU
   7  *
   8  * Modifications for inclusion into the Linux staging tree are
   9  * Copyright(c) 2010 Larry Finger. All rights reserved.
  10  *
  11  * Contact information:
  12  * WLAN FAE <wlanfae@realtek.com>
  13  * Larry Finger <Larry.Finger@lwfinger.net>
  14  *
  15  ******************************************************************************/
  16
  17 #define _XMIT_OSDEP_C_
  18
  19 #include <linux/usb.h>
  20 #include <linux/ip.h>
  21 #include <linux/if_ether.h>
  22 #include <linux/kmemleak.h>
  23
  24 #include "osdep_service.h"
  25 #include "drv_types.h"
  26
  27 #include "wifi.h"
  28 #include "mlme_osdep.h"
  29 #include "xmit_osdep.h"
  30 #include "osdep_intf.h"
  31
  32 static uint remainder_len(struct pkt_file *pfile)
  33 {
  34         return (uint)(pfile->buf_len - ((addr_t)(pfile->cur_addr) -
  35                (addr_t)(pfile->buf_start)));
  36 }
  37
  38 void _r8712_open_pktfile(_pkt *pktptr, struct pkt_file *pfile)
  39 {
  40         pfile->pkt = pktptr;
  41         pfile->cur_addr = pfile->buf_start = pktptr->data;
  42         pfile->pkt_len = pfile->buf_len = pktptr->len;
  43         pfile->cur_buffer = pfile->buf_start;
  44 }
  45
  46 uint _r8712_pktfile_read(struct pkt_file *pfile, u8 *rmem, uint rlen)
  47 {
  48         uint len;
  49
  50         len = remainder_len(pfile);
  51         len = (rlen > len) ? len : rlen;
  52         if (rmem)
  53                 skb_copy_bits(pfile->pkt, pfile->buf_len - pfile->pkt_len,
  54                               rmem, len);
  55         pfile->cur_addr += len;
  56         pfile->pkt_len -= len;
  57         return len;
  58 }
  59
  60 sint r8712_endofpktfile(struct pkt_file *pfile)
  61 {
  62         return (pfile->pkt_len == 0);
  63 }
  64
  65
  66 void r8712_set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib)
  67 {
  68         struct ethhdr etherhdr;
  69         struct iphdr ip_hdr;
  70         u16 UserPriority = 0;
  71
  72         _r8712_open_pktfile(ppktfile->pkt, ppktfile);
  73         _r8712_pktfile_read(ppktfile, (unsigned char *)&etherhdr, ETH_HLEN);
  74
  75         /* get UserPriority from IP hdr*/
  76         if (pattrib->ether_type == 0x0800) {
  77                 _r8712_pktfile_read(ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr));
  78                 /*UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3 ;*/
  79                 UserPriority = ip_hdr.tos >> 5;
  80         } else {
  81                 /* "When priority processing of data frames is supported,
  82                  * a STA's SME should send EAPOL-Key frames at the highest
  83                  * priority."
  84                  */
  85
  86                 if (pattrib->ether_type == 0x888e)
  87                         UserPriority = 7;
  88         }
  89         pattrib->priority = UserPriority;
  90         pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN;
  91         pattrib->subtype = WIFI_QOS_DATA_TYPE;
  92 }
  93
  94 void r8712_SetFilter(struct work_struct *work)
  95 {
  96         struct _adapter *adapter = container_of(work, struct _adapter,
  97                                                 wk_filter_rx_ff0);
  98         u8  oldvalue = 0x00, newvalue = 0x00;
  99         unsigned long irqL;
 100
 101         oldvalue = r8712_read8(adapter, 0x117);
 102         newvalue = oldvalue & 0xfe;
 103         r8712_write8(adapter, 0x117, newvalue);
 104
 105         spin_lock_irqsave(&adapter->lock_rx_ff0_filter, irqL);
 106         adapter->blnEnableRxFF0Filter = 1;
 107         spin_unlock_irqrestore(&adapter->lock_rx_ff0_filter, irqL);
 108         do {
 109                 msleep(100);
 110         } while (adapter->blnEnableRxFF0Filter == 1);
 111         r8712_write8(adapter, 0x117, oldvalue);
 112 }
 113
 114 int r8712_xmit_resource_alloc(struct _adapter *padapter,
 115                               struct xmit_buf *pxmitbuf)
 116 {
 117         int i;
 118
 119         for (i = 0; i < 8; i++) {
 120                 pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL);
 121                 if (!pxmitbuf->pxmit_urb[i]) {
 122                         int k;
 123
 124                         for (k = i - 1; k >= 0; k--) {
 125                                 /* handle allocation errors part way through loop */
 126                                 usb_free_urb(pxmitbuf->pxmit_urb[k]);
 127                         }
 128                         netdev_err(padapter->pnetdev, "pxmitbuf->pxmit_urb[i] == NULL\n");
 129                         return -ENOMEM;
 130                 }
 131                 kmemleak_not_leak(pxmitbuf->pxmit_urb[i]);
 132         }
 133         return 0;
 134 }
 135
 136 void r8712_xmit_resource_free(struct _adapter *padapter,
 137                               struct xmit_buf *pxmitbuf)
 138 {
 139         int i;
 140
 141         for (i = 0; i < 8; i++) {
 142                 if (pxmitbuf->pxmit_urb[i]) {
 143                         usb_kill_urb(pxmitbuf->pxmit_urb[i]);
 144                         usb_free_urb(pxmitbuf->pxmit_urb[i]);
 145                 }
 146         }
 147 }
 148
 149 void r8712_xmit_complete(struct _adapter *padapter, struct xmit_frame *pxframe)
 150 {
 151         if (pxframe->pkt)
 152                 dev_kfree_skb_any(pxframe->pkt);
 153         pxframe->pkt = NULL;
 154 }
 155
 156 int r8712_xmit_entry(_pkt *pkt, struct  net_device *netdev)
 157 {
 158         struct xmit_frame *xmitframe = NULL;
 159         struct _adapter *adapter = netdev_priv(netdev);
 160         struct xmit_priv *xmitpriv = &(adapter->xmitpriv);
 161
 162         if (!r8712_if_up(adapter))
 163                 goto _xmit_entry_drop;
 164
 165         xmitframe = r8712_alloc_xmitframe(xmitpriv);
 166         if (!xmitframe)
 167                 goto _xmit_entry_drop;
 168
 169         if (r8712_update_attrib(adapter, pkt, &xmitframe->attrib))
 170                 goto _xmit_entry_drop;
 171
 172         adapter->ledpriv.LedControlHandler(adapter, LED_CTL_TX);
 173         xmitframe->pkt = pkt;
 174         if (r8712_pre_xmit(adapter, xmitframe)) {
 175                 /*dump xmitframe directly or drop xframe*/
 176                 dev_kfree_skb_any(pkt);
 177                 xmitframe->pkt = NULL;
 178         }
 179         xmitpriv->tx_pkts++;
 180         xmitpriv->tx_bytes += xmitframe->attrib.last_txcmdsz;
 181         return 0;
 182 _xmit_entry_drop:
 183         if (xmitframe)
 184                 r8712_free_xmitframe(xmitpriv, xmitframe);
 185         xmitpriv->tx_drop++;
 186         dev_kfree_skb_any(pkt);
 187         return 0;
 188 }