• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /******************************************************************************
2  *
3  * Copyright(c) 2009-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  * 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
17  *
18  * The full GNU General Public License is included in this distribution in the
19  * file called LICENSE.
20  *
21  * Contact Information:
22  * wlanfae <wlanfae@realtek.com>
23  * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
24  * Hsinchu 300, Taiwan.
25  *
26  * Larry Finger <Larry.Finger@lwfinger.net>
27  *
28  *****************************************************************************/
29 
30 #include "../wifi.h"
31 #include "../usb.h"
32 #include "../ps.h"
33 #include "../base.h"
34 #include "reg.h"
35 #include "def.h"
36 #include "phy.h"
37 #include "rf.h"
38 #include "dm.h"
39 #include "mac.h"
40 #include "trx.h"
41 #include "../rtl8192c/fw_common.h"
42 
_ConfigVerTOutEP(struct ieee80211_hw * hw)43 static int _ConfigVerTOutEP(struct ieee80211_hw *hw)
44 {
45 	u8 ep_cfg, txqsele;
46 	u8 ep_nums = 0;
47 
48 	struct rtl_priv *rtlpriv = rtl_priv(hw);
49 	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);
50 	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);
51 
52 	rtlusb->out_queue_sel = 0;
53 	ep_cfg = rtl_read_byte(rtlpriv, REG_TEST_SIE_OPTIONAL);
54 	ep_cfg = (ep_cfg & USB_TEST_EP_MASK) >> USB_TEST_EP_SHIFT;
55 	switch (ep_cfg)	{
56 	case 0:		/* 2 bulk OUT, 1 bulk IN */
57 	case 3:
58 		rtlusb->out_queue_sel  = TX_SELE_HQ | TX_SELE_LQ;
59 		ep_nums = 2;
60 		break;
61 	case 1:	/* 1 bulk IN/OUT => map all endpoint to Low queue */
62 	case 2:	/* 1 bulk IN, 1 bulk OUT => map all endpoint to High queue */
63 		txqsele = rtl_read_byte(rtlpriv, REG_TEST_USB_TXQS);
64 		if (txqsele & 0x0F) /* /map all endpoint to High queue */
65 			rtlusb->out_queue_sel =  TX_SELE_HQ;
66 		else if (txqsele&0xF0) /* map all endpoint to Low queue */
67 			rtlusb->out_queue_sel =  TX_SELE_LQ;
68 		ep_nums = 1;
69 		break;
70 	default:
71 		break;
72 	}
73 	return (rtlusb->out_ep_nums == ep_nums) ? 0 : -EINVAL;
74 }
75 
_ConfigVerNOutEP(struct ieee80211_hw * hw)76 static int _ConfigVerNOutEP(struct ieee80211_hw *hw)
77 {
78 	u8 ep_cfg;
79 	u8 ep_nums = 0;
80 
81 	struct rtl_priv *rtlpriv = rtl_priv(hw);
82 	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);
83 	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);
84 
85 	rtlusb->out_queue_sel = 0;
86 	/* Normal and High queue */
87 	ep_cfg =  rtl_read_byte(rtlpriv, (REG_NORMAL_SIE_EP + 1));
88 	if (ep_cfg & USB_NORMAL_SIE_EP_MASK) {
89 		rtlusb->out_queue_sel |= TX_SELE_HQ;
90 		ep_nums++;
91 	}
92 	if ((ep_cfg >> USB_NORMAL_SIE_EP_SHIFT) & USB_NORMAL_SIE_EP_MASK) {
93 		rtlusb->out_queue_sel |= TX_SELE_NQ;
94 		ep_nums++;
95 	}
96 	/* Low queue */
97 	ep_cfg =  rtl_read_byte(rtlpriv, (REG_NORMAL_SIE_EP + 2));
98 	if (ep_cfg & USB_NORMAL_SIE_EP_MASK) {
99 		rtlusb->out_queue_sel |= TX_SELE_LQ;
100 		ep_nums++;
101 	}
102 	return (rtlusb->out_ep_nums == ep_nums) ? 0 : -EINVAL;
103 }
104 
_TwoOutEpMapping(struct ieee80211_hw * hw,bool bIsChipB,bool bwificfg,struct rtl_ep_map * ep_map)105 static void _TwoOutEpMapping(struct ieee80211_hw *hw, bool bIsChipB,
106 			     bool  bwificfg, struct rtl_ep_map *ep_map)
107 {
108 	struct rtl_priv *rtlpriv = rtl_priv(hw);
109 
110 	if (bwificfg) { /* for WMM */
111 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
112 			 "USB Chip-B & WMM Setting.....\n");
113 		ep_map->ep_mapping[RTL_TXQ_BE]	= 2;
114 		ep_map->ep_mapping[RTL_TXQ_BK]	= 3;
115 		ep_map->ep_mapping[RTL_TXQ_VI]	= 3;
116 		ep_map->ep_mapping[RTL_TXQ_VO] = 2;
117 		ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
118 		ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
119 		ep_map->ep_mapping[RTL_TXQ_HI]	= 2;
120 	} else { /* typical setting */
121 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
122 			 "USB typical Setting.....\n");
123 		ep_map->ep_mapping[RTL_TXQ_BE]	= 3;
124 		ep_map->ep_mapping[RTL_TXQ_BK]	= 3;
125 		ep_map->ep_mapping[RTL_TXQ_VI]	= 2;
126 		ep_map->ep_mapping[RTL_TXQ_VO]	= 2;
127 		ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
128 		ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
129 		ep_map->ep_mapping[RTL_TXQ_HI]	= 2;
130 	}
131 }
132 
_ThreeOutEpMapping(struct ieee80211_hw * hw,bool bwificfg,struct rtl_ep_map * ep_map)133 static void _ThreeOutEpMapping(struct ieee80211_hw *hw, bool  bwificfg,
134 			       struct rtl_ep_map *ep_map)
135 {
136 	struct rtl_priv *rtlpriv = rtl_priv(hw);
137 	if (bwificfg) { /* for WMM */
138 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
139 			 "USB 3EP Setting for WMM.....\n");
140 		ep_map->ep_mapping[RTL_TXQ_BE]	= 5;
141 		ep_map->ep_mapping[RTL_TXQ_BK]	= 3;
142 		ep_map->ep_mapping[RTL_TXQ_VI]	= 3;
143 		ep_map->ep_mapping[RTL_TXQ_VO]	= 2;
144 		ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
145 		ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
146 		ep_map->ep_mapping[RTL_TXQ_HI]	= 2;
147 	} else { /* typical setting */
148 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
149 			 "USB 3EP Setting for typical.....\n");
150 		ep_map->ep_mapping[RTL_TXQ_BE]	= 5;
151 		ep_map->ep_mapping[RTL_TXQ_BK]	= 5;
152 		ep_map->ep_mapping[RTL_TXQ_VI]	= 3;
153 		ep_map->ep_mapping[RTL_TXQ_VO]	= 2;
154 		ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
155 		ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
156 		ep_map->ep_mapping[RTL_TXQ_HI]	= 2;
157 	}
158 }
159 
_OneOutEpMapping(struct ieee80211_hw * hw,struct rtl_ep_map * ep_map)160 static void _OneOutEpMapping(struct ieee80211_hw *hw, struct rtl_ep_map *ep_map)
161 {
162 	ep_map->ep_mapping[RTL_TXQ_BE]	= 2;
163 	ep_map->ep_mapping[RTL_TXQ_BK]	= 2;
164 	ep_map->ep_mapping[RTL_TXQ_VI]	= 2;
165 	ep_map->ep_mapping[RTL_TXQ_VO] = 2;
166 	ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
167 	ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
168 	ep_map->ep_mapping[RTL_TXQ_HI]	= 2;
169 }
_out_ep_mapping(struct ieee80211_hw * hw)170 static int _out_ep_mapping(struct ieee80211_hw *hw)
171 {
172 	int err = 0;
173 	bool bIsChipN, bwificfg = false;
174 	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
175 	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);
176 	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);
177 	struct rtl_ep_map *ep_map = &(rtlusb->ep_map);
178 
179 	bIsChipN = IS_NORMAL_CHIP(rtlhal->version);
180 	switch (rtlusb->out_ep_nums) {
181 	case 2:
182 		_TwoOutEpMapping(hw, bIsChipN, bwificfg, ep_map);
183 		break;
184 	case 3:
185 		/* Test chip doesn't support three out EPs. */
186 		if (!bIsChipN) {
187 			err  =  -EINVAL;
188 			goto err_out;
189 		}
190 		_ThreeOutEpMapping(hw, bIsChipN, ep_map);
191 		break;
192 	case 1:
193 		_OneOutEpMapping(hw, ep_map);
194 		break;
195 	default:
196 		err  =  -EINVAL;
197 		break;
198 	}
199 err_out:
200 	return err;
201 
202 }
203 /* endpoint mapping */
rtl8192cu_endpoint_mapping(struct ieee80211_hw * hw)204 int  rtl8192cu_endpoint_mapping(struct ieee80211_hw *hw)
205 {
206 	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
207 	int error = 0;
208 	if (likely(IS_NORMAL_CHIP(rtlhal->version)))
209 		error = _ConfigVerNOutEP(hw);
210 	else
211 		error = _ConfigVerTOutEP(hw);
212 	if (error)
213 		goto err_out;
214 	error = _out_ep_mapping(hw);
215 	if (error)
216 		goto err_out;
217 err_out:
218 	return error;
219 }
220 
rtl8192cu_mq_to_hwq(__le16 fc,u16 mac80211_queue_index)221 u16 rtl8192cu_mq_to_hwq(__le16 fc, u16 mac80211_queue_index)
222 {
223 	u16 hw_queue_index;
224 
225 	if (unlikely(ieee80211_is_beacon(fc))) {
226 		hw_queue_index = RTL_TXQ_BCN;
227 		goto out;
228 	}
229 	if (ieee80211_is_mgmt(fc)) {
230 		hw_queue_index = RTL_TXQ_MGT;
231 		goto out;
232 	}
233 	switch (mac80211_queue_index) {
234 	case 0:
235 		hw_queue_index = RTL_TXQ_VO;
236 		break;
237 	case 1:
238 		hw_queue_index = RTL_TXQ_VI;
239 		break;
240 	case 2:
241 		hw_queue_index = RTL_TXQ_BE;
242 		break;
243 	case 3:
244 		hw_queue_index = RTL_TXQ_BK;
245 		break;
246 	default:
247 		hw_queue_index = RTL_TXQ_BE;
248 		RT_ASSERT(false, "QSLT_BE queue, skb_queue:%d\n",
249 			  mac80211_queue_index);
250 		break;
251 	}
252 out:
253 	return hw_queue_index;
254 }
255 
_rtl8192cu_mq_to_descq(struct ieee80211_hw * hw,__le16 fc,u16 mac80211_queue_index)256 static enum rtl_desc_qsel _rtl8192cu_mq_to_descq(struct ieee80211_hw *hw,
257 					 __le16 fc, u16 mac80211_queue_index)
258 {
259 	enum rtl_desc_qsel qsel;
260 	struct rtl_priv *rtlpriv = rtl_priv(hw);
261 
262 	if (unlikely(ieee80211_is_beacon(fc))) {
263 		qsel = QSLT_BEACON;
264 		goto out;
265 	}
266 	if (ieee80211_is_mgmt(fc)) {
267 		qsel = QSLT_MGNT;
268 		goto out;
269 	}
270 	switch (mac80211_queue_index) {
271 	case 0:	/* VO */
272 		qsel = QSLT_VO;
273 		RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
274 			 "VO queue, set qsel = 0x%x\n", QSLT_VO);
275 		break;
276 	case 1:	/* VI */
277 		qsel = QSLT_VI;
278 		RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
279 			 "VI queue, set qsel = 0x%x\n", QSLT_VI);
280 		break;
281 	case 3:	/* BK */
282 		qsel = QSLT_BK;
283 		RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
284 			 "BK queue, set qsel = 0x%x\n", QSLT_BK);
285 		break;
286 	case 2:	/* BE */
287 	default:
288 		qsel = QSLT_BE;
289 		RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
290 			 "BE queue, set qsel = 0x%x\n", QSLT_BE);
291 		break;
292 	}
293 out:
294 	return qsel;
295 }
296 
297 /* =============================================================== */
298 
299 /*----------------------------------------------------------------------
300  *
301  *	Rx handler
302  *
303  *---------------------------------------------------------------------- */
rtl92cu_rx_query_desc(struct ieee80211_hw * hw,struct rtl_stats * stats,struct ieee80211_rx_status * rx_status,u8 * pdesc,struct sk_buff * skb)304 bool rtl92cu_rx_query_desc(struct ieee80211_hw *hw,
305 			   struct rtl_stats *stats,
306 			   struct ieee80211_rx_status *rx_status,
307 			   u8 *pdesc, struct sk_buff *skb)
308 {
309 	struct rx_fwinfo_92c *p_drvinfo;
310 	struct rx_desc_92c *p_desc = (struct rx_desc_92c *)pdesc;
311 	u32 phystatus = GET_RX_DESC_PHY_STATUS(pdesc);
312 
313 	stats->length = (u16) GET_RX_DESC_PKT_LEN(pdesc);
314 	stats->rx_drvinfo_size = (u8)GET_RX_DESC_DRVINFO_SIZE(pdesc) *
315 				 RX_DRV_INFO_SIZE_UNIT;
316 	stats->rx_bufshift = (u8) (GET_RX_DESC_SHIFT(pdesc) & 0x03);
317 	stats->icv = (u16) GET_RX_DESC_ICV(pdesc);
318 	stats->crc = (u16) GET_RX_DESC_CRC32(pdesc);
319 	stats->hwerror = (stats->crc | stats->icv);
320 	stats->decrypted = !GET_RX_DESC_SWDEC(pdesc);
321 	stats->rate = (u8) GET_RX_DESC_RX_MCS(pdesc);
322 	stats->shortpreamble = (u16) GET_RX_DESC_SPLCP(pdesc);
323 	stats->isampdu = (bool) (GET_RX_DESC_PAGGR(pdesc) == 1);
324 	stats->isampdu = (bool) ((GET_RX_DESC_PAGGR(pdesc) == 1)
325 				   && (GET_RX_DESC_FAGGR(pdesc) == 1));
326 	stats->timestamp_low = GET_RX_DESC_TSFL(pdesc);
327 	stats->rx_is40Mhzpacket = (bool) GET_RX_DESC_BW(pdesc);
328 	rx_status->freq = hw->conf.chandef.chan->center_freq;
329 	rx_status->band = hw->conf.chandef.chan->band;
330 	if (GET_RX_DESC_CRC32(pdesc))
331 		rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
332 	if (!GET_RX_DESC_SWDEC(pdesc))
333 		rx_status->flag |= RX_FLAG_DECRYPTED;
334 	if (GET_RX_DESC_BW(pdesc))
335 		rx_status->flag |= RX_FLAG_40MHZ;
336 	if (GET_RX_DESC_RX_HT(pdesc))
337 		rx_status->flag |= RX_FLAG_HT;
338 	rx_status->flag |= RX_FLAG_MACTIME_START;
339 	if (stats->decrypted)
340 		rx_status->flag |= RX_FLAG_DECRYPTED;
341 	rx_status->rate_idx = rtlwifi_rate_mapping(hw,
342 					(bool)GET_RX_DESC_RX_HT(pdesc),
343 					(u8)GET_RX_DESC_RX_MCS(pdesc),
344 					(bool)GET_RX_DESC_PAGGR(pdesc));
345 	rx_status->mactime = GET_RX_DESC_TSFL(pdesc);
346 	if (phystatus) {
347 		p_drvinfo = (struct rx_fwinfo_92c *)(skb->data +
348 						     stats->rx_bufshift);
349 		rtl92c_translate_rx_signal_stuff(hw, skb, stats, p_desc,
350 						 p_drvinfo);
351 	}
352 	/*rx_status->qual = stats->signal; */
353 	rx_status->signal = stats->recvsignalpower + 10;
354 	return true;
355 }
356 
357 #define RTL_RX_DRV_INFO_UNIT		8
358 
_rtl_rx_process(struct ieee80211_hw * hw,struct sk_buff * skb)359 static void _rtl_rx_process(struct ieee80211_hw *hw, struct sk_buff *skb)
360 {
361 	struct ieee80211_rx_status *rx_status =
362 		 (struct ieee80211_rx_status *)IEEE80211_SKB_RXCB(skb);
363 	u32 skb_len, pkt_len, drvinfo_len;
364 	struct rtl_priv *rtlpriv = rtl_priv(hw);
365 	u8 *rxdesc;
366 	struct rtl_stats stats = {
367 		.signal = 0,
368 		.rate = 0,
369 	};
370 	struct rx_fwinfo_92c *p_drvinfo;
371 	bool bv;
372 	__le16 fc;
373 	struct ieee80211_hdr *hdr;
374 
375 	memset(rx_status, 0, sizeof(*rx_status));
376 	rxdesc	= skb->data;
377 	skb_len	= skb->len;
378 	drvinfo_len = (GET_RX_DESC_DRVINFO_SIZE(rxdesc) * RTL_RX_DRV_INFO_UNIT);
379 	pkt_len		= GET_RX_DESC_PKT_LEN(rxdesc);
380 	/* TODO: Error recovery. drop this skb or something. */
381 	WARN_ON(skb_len < (pkt_len + RTL_RX_DESC_SIZE + drvinfo_len));
382 	stats.length = (u16) GET_RX_DESC_PKT_LEN(rxdesc);
383 	stats.rx_drvinfo_size = (u8)GET_RX_DESC_DRVINFO_SIZE(rxdesc) *
384 				RX_DRV_INFO_SIZE_UNIT;
385 	stats.rx_bufshift = (u8) (GET_RX_DESC_SHIFT(rxdesc) & 0x03);
386 	stats.icv = (u16) GET_RX_DESC_ICV(rxdesc);
387 	stats.crc = (u16) GET_RX_DESC_CRC32(rxdesc);
388 	stats.hwerror = (stats.crc | stats.icv);
389 	stats.decrypted = !GET_RX_DESC_SWDEC(rxdesc);
390 	stats.rate = (u8) GET_RX_DESC_RX_MCS(rxdesc);
391 	stats.shortpreamble = (u16) GET_RX_DESC_SPLCP(rxdesc);
392 	stats.isampdu = (bool) ((GET_RX_DESC_PAGGR(rxdesc) == 1)
393 				   && (GET_RX_DESC_FAGGR(rxdesc) == 1));
394 	stats.timestamp_low = GET_RX_DESC_TSFL(rxdesc);
395 	stats.rx_is40Mhzpacket = (bool) GET_RX_DESC_BW(rxdesc);
396 	/* TODO: is center_freq changed when doing scan? */
397 	/* TODO: Shall we add protection or just skip those two step? */
398 	rx_status->freq = hw->conf.chandef.chan->center_freq;
399 	rx_status->band = hw->conf.chandef.chan->band;
400 	if (GET_RX_DESC_CRC32(rxdesc))
401 		rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
402 	if (!GET_RX_DESC_SWDEC(rxdesc))
403 		rx_status->flag |= RX_FLAG_DECRYPTED;
404 	if (GET_RX_DESC_BW(rxdesc))
405 		rx_status->flag |= RX_FLAG_40MHZ;
406 	if (GET_RX_DESC_RX_HT(rxdesc))
407 		rx_status->flag |= RX_FLAG_HT;
408 	/* Data rate */
409 	rx_status->rate_idx = rtlwifi_rate_mapping(hw,
410 					(bool)GET_RX_DESC_RX_HT(rxdesc),
411 					(u8)GET_RX_DESC_RX_MCS(rxdesc),
412 					(bool)GET_RX_DESC_PAGGR(rxdesc));
413 	/*  There is a phy status after this rx descriptor. */
414 	if (GET_RX_DESC_PHY_STATUS(rxdesc)) {
415 		p_drvinfo = (struct rx_fwinfo_92c *)(rxdesc + RTL_RX_DESC_SIZE);
416 		rtl92c_translate_rx_signal_stuff(hw, skb, &stats,
417 				 (struct rx_desc_92c *)rxdesc, p_drvinfo);
418 	}
419 	skb_pull(skb, (drvinfo_len + RTL_RX_DESC_SIZE));
420 	hdr = (struct ieee80211_hdr *)(skb->data);
421 	fc = hdr->frame_control;
422 	bv = ieee80211_is_probe_resp(fc);
423 	if (bv)
424 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
425 			 "Got probe response frame\n");
426 	if (ieee80211_is_beacon(fc))
427 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Got beacon frame\n");
428 	if (ieee80211_is_data(fc))
429 		RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Got data frame\n");
430 	RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
431 		 "Fram: fc = 0x%X addr1 = 0x%02X:0x%02X:0x%02X:0x%02X:0x%02X:0x%02X\n",
432 		 fc,
433 		 (u32)hdr->addr1[0], (u32)hdr->addr1[1],
434 		 (u32)hdr->addr1[2], (u32)hdr->addr1[3],
435 		 (u32)hdr->addr1[4], (u32)hdr->addr1[5]);
436 	memcpy(IEEE80211_SKB_RXCB(skb), rx_status, sizeof(*rx_status));
437 	ieee80211_rx(hw, skb);
438 }
439 
rtl8192cu_rx_hdl(struct ieee80211_hw * hw,struct sk_buff * skb)440 void  rtl8192cu_rx_hdl(struct ieee80211_hw *hw, struct sk_buff * skb)
441 {
442 	_rtl_rx_process(hw, skb);
443 }
444 
rtl8192c_rx_segregate_hdl(struct ieee80211_hw * hw,struct sk_buff * skb,struct sk_buff_head * skb_list)445 void rtl8192c_rx_segregate_hdl(
446 	struct ieee80211_hw *hw,
447 	struct sk_buff *skb,
448 	struct sk_buff_head *skb_list)
449 {
450 }
451 
452 /*----------------------------------------------------------------------
453  *
454  *	Tx handler
455  *
456  *---------------------------------------------------------------------- */
rtl8192c_tx_cleanup(struct ieee80211_hw * hw,struct sk_buff * skb)457 void rtl8192c_tx_cleanup(struct ieee80211_hw *hw, struct sk_buff  *skb)
458 {
459 }
460 
rtl8192c_tx_post_hdl(struct ieee80211_hw * hw,struct urb * urb,struct sk_buff * skb)461 int rtl8192c_tx_post_hdl(struct ieee80211_hw *hw, struct urb *urb,
462 			 struct sk_buff *skb)
463 {
464 	return 0;
465 }
466 
rtl8192c_tx_aggregate_hdl(struct ieee80211_hw * hw,struct sk_buff_head * list)467 struct sk_buff *rtl8192c_tx_aggregate_hdl(struct ieee80211_hw *hw,
468 					   struct sk_buff_head *list)
469 {
470 	return skb_dequeue(list);
471 }
472 
473 /*======================================== trx ===============================*/
474 
_rtl_fill_usb_tx_desc(u8 * txdesc)475 static void _rtl_fill_usb_tx_desc(u8 *txdesc)
476 {
477 	SET_TX_DESC_OWN(txdesc, 1);
478 	SET_TX_DESC_LAST_SEG(txdesc, 1);
479 	SET_TX_DESC_FIRST_SEG(txdesc, 1);
480 }
481 /**
482  *	For HW recovery information
483  */
_rtl_tx_desc_checksum(u8 * txdesc)484 static void _rtl_tx_desc_checksum(u8 *txdesc)
485 {
486 	u16 *ptr = (u16 *)txdesc;
487 	u16	checksum = 0;
488 	u32 index;
489 
490 	/* Clear first */
491 	SET_TX_DESC_TX_DESC_CHECKSUM(txdesc, 0);
492 	for (index = 0; index < 16; index++)
493 		checksum = checksum ^ (*(ptr + index));
494 	SET_TX_DESC_TX_DESC_CHECKSUM(txdesc, checksum);
495 }
496 
rtl92cu_tx_fill_desc(struct ieee80211_hw * hw,struct ieee80211_hdr * hdr,u8 * pdesc_tx,u8 * pbd_desc_tx,struct ieee80211_tx_info * info,struct ieee80211_sta * sta,struct sk_buff * skb,u8 queue_index,struct rtl_tcb_desc * tcb_desc)497 void rtl92cu_tx_fill_desc(struct ieee80211_hw *hw,
498 			  struct ieee80211_hdr *hdr, u8 *pdesc_tx,
499 			  u8 *pbd_desc_tx, struct ieee80211_tx_info *info,
500 			  struct ieee80211_sta *sta,
501 			  struct sk_buff *skb,
502 			  u8 queue_index,
503 			  struct rtl_tcb_desc *tcb_desc)
504 {
505 	struct rtl_priv *rtlpriv = rtl_priv(hw);
506 	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
507 	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
508 	bool defaultadapter = true;
509 	u8 *qc = ieee80211_get_qos_ctl(hdr);
510 	u8 tid = qc[0] & IEEE80211_QOS_CTL_TID_MASK;
511 	u16 seq_number;
512 	__le16 fc = hdr->frame_control;
513 	u8 rate_flag = info->control.rates[0].flags;
514 	u16 pktlen = skb->len;
515 	enum rtl_desc_qsel fw_qsel = _rtl8192cu_mq_to_descq(hw, fc,
516 						skb_get_queue_mapping(skb));
517 	u8 *txdesc;
518 
519 	seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;
520 	rtl_get_tcb_desc(hw, info, sta, skb, tcb_desc);
521 	txdesc = (u8 *)skb_push(skb, RTL_TX_HEADER_SIZE);
522 	memset(txdesc, 0, RTL_TX_HEADER_SIZE);
523 	SET_TX_DESC_PKT_SIZE(txdesc, pktlen);
524 	SET_TX_DESC_LINIP(txdesc, 0);
525 	SET_TX_DESC_PKT_OFFSET(txdesc, RTL_DUMMY_OFFSET);
526 	SET_TX_DESC_OFFSET(txdesc, RTL_TX_HEADER_SIZE);
527 	SET_TX_DESC_TX_RATE(txdesc, tcb_desc->hw_rate);
528 	if (tcb_desc->use_shortgi || tcb_desc->use_shortpreamble)
529 		SET_TX_DESC_DATA_SHORTGI(txdesc, 1);
530 	if (mac->tids[tid].agg.agg_state == RTL_AGG_ON &&
531 		    info->flags & IEEE80211_TX_CTL_AMPDU) {
532 		SET_TX_DESC_AGG_ENABLE(txdesc, 1);
533 		SET_TX_DESC_MAX_AGG_NUM(txdesc, 0x14);
534 	} else {
535 		SET_TX_DESC_AGG_BREAK(txdesc, 1);
536 	}
537 	SET_TX_DESC_SEQ(txdesc, seq_number);
538 	SET_TX_DESC_RTS_ENABLE(txdesc, ((tcb_desc->rts_enable &&
539 			       !tcb_desc->cts_enable) ? 1 : 0));
540 	SET_TX_DESC_HW_RTS_ENABLE(txdesc, ((tcb_desc->rts_enable ||
541 				  tcb_desc->cts_enable) ? 1 : 0));
542 	SET_TX_DESC_CTS2SELF(txdesc, ((tcb_desc->cts_enable) ? 1 : 0));
543 	SET_TX_DESC_RTS_STBC(txdesc, ((tcb_desc->rts_stbc) ? 1 : 0));
544 	SET_TX_DESC_RTS_RATE(txdesc, tcb_desc->rts_rate);
545 	SET_TX_DESC_RTS_BW(txdesc, 0);
546 	SET_TX_DESC_RTS_SC(txdesc, tcb_desc->rts_sc);
547 	SET_TX_DESC_RTS_SHORT(txdesc,
548 			      ((tcb_desc->rts_rate <= DESC92_RATE54M) ?
549 			       (tcb_desc->rts_use_shortpreamble ? 1 : 0)
550 			       : (tcb_desc->rts_use_shortgi ? 1 : 0)));
551 	if (mac->bw_40) {
552 		if (rate_flag & IEEE80211_TX_RC_DUP_DATA) {
553 			SET_TX_DESC_DATA_BW(txdesc, 1);
554 			SET_TX_DESC_DATA_SC(txdesc, 3);
555 		} else if(rate_flag & IEEE80211_TX_RC_40_MHZ_WIDTH){
556 			SET_TX_DESC_DATA_BW(txdesc, 1);
557 			SET_TX_DESC_DATA_SC(txdesc, mac->cur_40_prime_sc);
558 		} else {
559 			SET_TX_DESC_DATA_BW(txdesc, 0);
560 			SET_TX_DESC_DATA_SC(txdesc, 0);
561 		}
562 	} else {
563 		SET_TX_DESC_DATA_BW(txdesc, 0);
564 		SET_TX_DESC_DATA_SC(txdesc, 0);
565 	}
566 	rcu_read_lock();
567 	sta = ieee80211_find_sta(mac->vif, mac->bssid);
568 	if (sta) {
569 		u8 ampdu_density = sta->ht_cap.ampdu_density;
570 		SET_TX_DESC_AMPDU_DENSITY(txdesc, ampdu_density);
571 	}
572 	rcu_read_unlock();
573 	if (info->control.hw_key) {
574 		struct ieee80211_key_conf *keyconf = info->control.hw_key;
575 		switch (keyconf->cipher) {
576 		case WLAN_CIPHER_SUITE_WEP40:
577 		case WLAN_CIPHER_SUITE_WEP104:
578 		case WLAN_CIPHER_SUITE_TKIP:
579 			SET_TX_DESC_SEC_TYPE(txdesc, 0x1);
580 			break;
581 		case WLAN_CIPHER_SUITE_CCMP:
582 			SET_TX_DESC_SEC_TYPE(txdesc, 0x3);
583 			break;
584 		default:
585 			SET_TX_DESC_SEC_TYPE(txdesc, 0x0);
586 			break;
587 		}
588 	}
589 	SET_TX_DESC_PKT_ID(txdesc, 0);
590 	SET_TX_DESC_QUEUE_SEL(txdesc, fw_qsel);
591 	SET_TX_DESC_DATA_RATE_FB_LIMIT(txdesc, 0x1F);
592 	SET_TX_DESC_RTS_RATE_FB_LIMIT(txdesc, 0xF);
593 	SET_TX_DESC_DISABLE_FB(txdesc, 0);
594 	SET_TX_DESC_USE_RATE(txdesc, tcb_desc->use_driver_rate ? 1 : 0);
595 	if (ieee80211_is_data_qos(fc)) {
596 		if (mac->rdg_en) {
597 			RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE,
598 				 "Enable RDG function\n");
599 			SET_TX_DESC_RDG_ENABLE(txdesc, 1);
600 			SET_TX_DESC_HTC(txdesc, 1);
601 		}
602 	}
603 	if (rtlpriv->dm.useramask) {
604 		SET_TX_DESC_RATE_ID(txdesc, tcb_desc->ratr_index);
605 		SET_TX_DESC_MACID(txdesc, tcb_desc->mac_id);
606 	} else {
607 		SET_TX_DESC_RATE_ID(txdesc, 0xC + tcb_desc->ratr_index);
608 		SET_TX_DESC_MACID(txdesc, tcb_desc->ratr_index);
609 	}
610 	if ((!ieee80211_is_data_qos(fc)) && ppsc->leisure_ps &&
611 	      ppsc->fwctrl_lps) {
612 		SET_TX_DESC_HWSEQ_EN(txdesc, 1);
613 		SET_TX_DESC_PKT_ID(txdesc, 8);
614 		if (!defaultadapter)
615 			SET_TX_DESC_QOS(txdesc, 1);
616 	}
617 	if (ieee80211_has_morefrags(fc))
618 		SET_TX_DESC_MORE_FRAG(txdesc, 1);
619 	if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) ||
620 	    is_broadcast_ether_addr(ieee80211_get_DA(hdr)))
621 		SET_TX_DESC_BMC(txdesc, 1);
622 	_rtl_fill_usb_tx_desc(txdesc);
623 	_rtl_tx_desc_checksum(txdesc);
624 	RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE, "==>\n");
625 }
626 
rtl92cu_fill_fake_txdesc(struct ieee80211_hw * hw,u8 * pDesc,u32 buffer_len,bool bIsPsPoll)627 void rtl92cu_fill_fake_txdesc(struct ieee80211_hw *hw, u8 * pDesc,
628 			      u32 buffer_len, bool bIsPsPoll)
629 {
630 	/* Clear all status */
631 	memset(pDesc, 0, RTL_TX_HEADER_SIZE);
632 	SET_TX_DESC_FIRST_SEG(pDesc, 1); /* bFirstSeg; */
633 	SET_TX_DESC_LAST_SEG(pDesc, 1); /* bLastSeg; */
634 	SET_TX_DESC_OFFSET(pDesc, RTL_TX_HEADER_SIZE); /* Offset = 32 */
635 	SET_TX_DESC_PKT_SIZE(pDesc, buffer_len); /* Buffer size + command hdr */
636 	SET_TX_DESC_QUEUE_SEL(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */
637 	/* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error
638 	 * vlaue by Hw. */
639 	if (bIsPsPoll) {
640 		SET_TX_DESC_NAV_USE_HDR(pDesc, 1);
641 	} else {
642 		SET_TX_DESC_HWSEQ_EN(pDesc, 1); /* Hw set sequence number */
643 		SET_TX_DESC_PKT_ID(pDesc, 0x100); /* set bit3 to 1. */
644 	}
645 	SET_TX_DESC_USE_RATE(pDesc, 1); /* use data rate which is set by Sw */
646 	SET_TX_DESC_OWN(pDesc, 1);
647 	SET_TX_DESC_TX_RATE(pDesc, DESC92_RATE1M);
648 	_rtl_tx_desc_checksum(pDesc);
649 }
650 
rtl92cu_tx_fill_cmddesc(struct ieee80211_hw * hw,u8 * pdesc,bool firstseg,bool lastseg,struct sk_buff * skb)651 void rtl92cu_tx_fill_cmddesc(struct ieee80211_hw *hw,
652 			     u8 *pdesc, bool firstseg,
653 			     bool lastseg, struct sk_buff *skb)
654 {
655 	struct rtl_priv *rtlpriv = rtl_priv(hw);
656 	u8 fw_queue = QSLT_BEACON;
657 	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)(skb->data);
658 	__le16 fc = hdr->frame_control;
659 
660 	memset((void *)pdesc, 0, RTL_TX_HEADER_SIZE);
661 	if (firstseg)
662 		SET_TX_DESC_OFFSET(pdesc, RTL_TX_HEADER_SIZE);
663 	SET_TX_DESC_TX_RATE(pdesc, DESC92_RATE1M);
664 	SET_TX_DESC_SEQ(pdesc, 0);
665 	SET_TX_DESC_LINIP(pdesc, 0);
666 	SET_TX_DESC_QUEUE_SEL(pdesc, fw_queue);
667 	SET_TX_DESC_FIRST_SEG(pdesc, 1);
668 	SET_TX_DESC_LAST_SEG(pdesc, 1);
669 	SET_TX_DESC_RATE_ID(pdesc, 7);
670 	SET_TX_DESC_MACID(pdesc, 0);
671 	SET_TX_DESC_OWN(pdesc, 1);
672 	SET_TX_DESC_PKT_SIZE(pdesc, (u16)skb->len);
673 	SET_TX_DESC_FIRST_SEG(pdesc, 1);
674 	SET_TX_DESC_LAST_SEG(pdesc, 1);
675 	SET_TX_DESC_OFFSET(pdesc, 0x20);
676 	SET_TX_DESC_USE_RATE(pdesc, 1);
677 	if (!ieee80211_is_data_qos(fc)) {
678 		SET_TX_DESC_HWSEQ_EN(pdesc, 1);
679 		SET_TX_DESC_PKT_ID(pdesc, 8);
680 	}
681 	RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD, "H2C Tx Cmd Content",
682 		      pdesc, RTL_TX_DESC_SIZE);
683 }
684 
rtl92cu_cmd_send_packet(struct ieee80211_hw * hw,struct sk_buff * skb)685 bool rtl92cu_cmd_send_packet(struct ieee80211_hw *hw, struct sk_buff *skb)
686 {
687 	return true;
688 }
689