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 
remainder_len(struct pkt_file * pfile)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 
_r8712_open_pktfile(_pkt * pktptr,struct pkt_file * pfile)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 
_r8712_pktfile_read(struct pkt_file * pfile,u8 * rmem,uint rlen)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 
r8712_endofpktfile(struct pkt_file * pfile)60 sint r8712_endofpktfile(struct pkt_file *pfile)
61 {
62 	return (pfile->pkt_len == 0);
63 }
64 
r8712_set_qos(struct pkt_file * ppktfile,struct pkt_attrib * pattrib)65 void r8712_set_qos(struct pkt_file *ppktfile, struct pkt_attrib *pattrib)
66 {
67 	struct ethhdr etherhdr;
68 	struct iphdr ip_hdr;
69 	u16 UserPriority = 0;
70 
71 	_r8712_open_pktfile(ppktfile->pkt, ppktfile);
72 	_r8712_pktfile_read(ppktfile, (unsigned char *)&etherhdr, ETH_HLEN);
73 
74 	/* get UserPriority from IP hdr*/
75 	if (pattrib->ether_type == 0x0800) {
76 		_r8712_pktfile_read(ppktfile, (u8 *)&ip_hdr, sizeof(ip_hdr));
77 		/*UserPriority = (ntohs(ip_hdr.tos) >> 5) & 0x3 ;*/
78 		UserPriority = ip_hdr.tos >> 5;
79 	} else {
80 		/* "When priority processing of data frames is supported,
81 		 * a STA's SME should send EAPOL-Key frames at the highest
82 		 * priority."
83 		 */
84 
85 		if (pattrib->ether_type == 0x888e)
86 			UserPriority = 7;
87 	}
88 	pattrib->priority = UserPriority;
89 	pattrib->hdrlen = WLAN_HDR_A3_QOS_LEN;
90 	pattrib->subtype = WIFI_QOS_DATA_TYPE;
91 }
92 
r8712_SetFilter(struct work_struct * work)93 void r8712_SetFilter(struct work_struct *work)
94 {
95 	struct _adapter *adapter = container_of(work, struct _adapter,
96 						wk_filter_rx_ff0);
97 	u8  oldvalue = 0x00, newvalue = 0x00;
98 	unsigned long irqL;
99 
100 	oldvalue = r8712_read8(adapter, 0x117);
101 	newvalue = oldvalue & 0xfe;
102 	r8712_write8(adapter, 0x117, newvalue);
103 
104 	spin_lock_irqsave(&adapter->lock_rx_ff0_filter, irqL);
105 	adapter->blnEnableRxFF0Filter = 1;
106 	spin_unlock_irqrestore(&adapter->lock_rx_ff0_filter, irqL);
107 	do {
108 		msleep(100);
109 	} while (adapter->blnEnableRxFF0Filter == 1);
110 	r8712_write8(adapter, 0x117, oldvalue);
111 }
112 
r8712_xmit_resource_alloc(struct _adapter * padapter,struct xmit_buf * pxmitbuf)113 int r8712_xmit_resource_alloc(struct _adapter *padapter,
114 			      struct xmit_buf *pxmitbuf)
115 {
116 	int i;
117 
118 	for (i = 0; i < 8; i++) {
119 		pxmitbuf->pxmit_urb[i] = usb_alloc_urb(0, GFP_KERNEL);
120 		if (!pxmitbuf->pxmit_urb[i]) {
121 			netdev_err(padapter->pnetdev, "pxmitbuf->pxmit_urb[i] == NULL\n");
122 			return -ENOMEM;
123 		}
124 		kmemleak_not_leak(pxmitbuf->pxmit_urb[i]);
125 	}
126 	return 0;
127 }
128 
r8712_xmit_resource_free(struct _adapter * padapter,struct xmit_buf * pxmitbuf)129 void r8712_xmit_resource_free(struct _adapter *padapter,
130 			      struct xmit_buf *pxmitbuf)
131 {
132 	int i;
133 
134 	for (i = 0; i < 8; i++) {
135 		if (pxmitbuf->pxmit_urb[i]) {
136 			usb_kill_urb(pxmitbuf->pxmit_urb[i]);
137 			usb_free_urb(pxmitbuf->pxmit_urb[i]);
138 		}
139 	}
140 }
141 
r8712_xmit_complete(struct _adapter * padapter,struct xmit_frame * pxframe)142 void r8712_xmit_complete(struct _adapter *padapter, struct xmit_frame *pxframe)
143 {
144 	if (pxframe->pkt)
145 		dev_kfree_skb_any(pxframe->pkt);
146 	pxframe->pkt = NULL;
147 }
148 
r8712_xmit_entry(_pkt * pkt,struct net_device * netdev)149 int r8712_xmit_entry(_pkt *pkt, struct  net_device *netdev)
150 {
151 	struct xmit_frame *xmitframe = NULL;
152 	struct _adapter *adapter = netdev_priv(netdev);
153 	struct xmit_priv *xmitpriv = &(adapter->xmitpriv);
154 
155 	if (!r8712_if_up(adapter))
156 		goto _xmit_entry_drop;
157 
158 	xmitframe = r8712_alloc_xmitframe(xmitpriv);
159 	if (!xmitframe)
160 		goto _xmit_entry_drop;
161 
162 	if (r8712_update_attrib(adapter, pkt, &xmitframe->attrib))
163 		goto _xmit_entry_drop;
164 
165 	adapter->ledpriv.LedControlHandler(adapter, LED_CTL_TX);
166 	xmitframe->pkt = pkt;
167 	if (r8712_pre_xmit(adapter, xmitframe)) {
168 		/*dump xmitframe directly or drop xframe*/
169 		dev_kfree_skb_any(pkt);
170 		xmitframe->pkt = NULL;
171 	}
172 	xmitpriv->tx_pkts++;
173 	xmitpriv->tx_bytes += xmitframe->attrib.last_txcmdsz;
174 	return 0;
175 _xmit_entry_drop:
176 	if (xmitframe)
177 		r8712_free_xmitframe(xmitpriv, xmitframe);
178 	xmitpriv->tx_drop++;
179 	dev_kfree_skb_any(pkt);
180 	return 0;
181 }
182