brintos

brintos / linux-shallow public Read only

0
0
Text · 19.6 KiB · aa702ba Raw
644 lines · c
1// SPDX-License-Identifier: GPL-2.02/* Copyright(c) 2009-2012  Realtek Corporation.*/3 4#include "../wifi.h"5#include "../usb.h"6#include "../ps.h"7#include "../base.h"8#include "reg.h"9#include "def.h"10#include "phy.h"11#include "rf.h"12#include "dm.h"13#include "mac.h"14#include "trx.h"15#include "../rtl8192c/fw_common.h"16 17static int configvertoutep(struct ieee80211_hw *hw)18{19	u8 ep_cfg, txqsele;20	u8 ep_nums = 0;21 22	struct rtl_priv *rtlpriv = rtl_priv(hw);23	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);24	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);25 26	rtlusb->out_queue_sel = 0;27	ep_cfg = rtl_read_byte(rtlpriv, REG_TEST_SIE_OPTIONAL);28	ep_cfg = (ep_cfg & USB_TEST_EP_MASK) >> USB_TEST_EP_SHIFT;29	switch (ep_cfg)	{30	case 0:		/* 2 bulk OUT, 1 bulk IN */31	case 3:32		rtlusb->out_queue_sel  = TX_SELE_HQ | TX_SELE_LQ;33		ep_nums = 2;34		break;35	case 1:	/* 1 bulk IN/OUT => map all endpoint to Low queue */36	case 2:	/* 1 bulk IN, 1 bulk OUT => map all endpoint to High queue */37		txqsele = rtl_read_byte(rtlpriv, REG_TEST_USB_TXQS);38		if (txqsele & 0x0F) /* /map all endpoint to High queue */39			rtlusb->out_queue_sel =  TX_SELE_HQ;40		else if (txqsele&0xF0) /* map all endpoint to Low queue */41			rtlusb->out_queue_sel =  TX_SELE_LQ;42		ep_nums = 1;43		break;44	default:45		break;46	}47	return (rtlusb->out_ep_nums == ep_nums) ? 0 : -EINVAL;48}49 50static int configvernoutep(struct ieee80211_hw *hw)51{52	u8 ep_cfg;53	u8 ep_nums = 0;54 55	struct rtl_priv *rtlpriv = rtl_priv(hw);56	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);57	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);58 59	rtlusb->out_queue_sel = 0;60	/* Normal and High queue */61	ep_cfg =  rtl_read_byte(rtlpriv, (REG_NORMAL_SIE_EP + 1));62	if (ep_cfg & USB_NORMAL_SIE_EP_MASK) {63		rtlusb->out_queue_sel |= TX_SELE_HQ;64		ep_nums++;65	}66	if ((ep_cfg >> USB_NORMAL_SIE_EP_SHIFT) & USB_NORMAL_SIE_EP_MASK) {67		rtlusb->out_queue_sel |= TX_SELE_NQ;68		ep_nums++;69	}70	/* Low queue */71	ep_cfg =  rtl_read_byte(rtlpriv, (REG_NORMAL_SIE_EP + 2));72	if (ep_cfg & USB_NORMAL_SIE_EP_MASK) {73		rtlusb->out_queue_sel |= TX_SELE_LQ;74		ep_nums++;75	}76	return (rtlusb->out_ep_nums == ep_nums) ? 0 : -EINVAL;77}78 79static void twooutepmapping(struct ieee80211_hw *hw, bool is_chip8,80			     bool  bwificfg, struct rtl_ep_map *ep_map)81{82	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);83	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);84	struct rtl_priv *rtlpriv = rtl_priv(hw);85 86	if (bwificfg) { /* for WMM */87		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG,88			"USB Chip-B & WMM Setting.....\n");89		ep_map->ep_mapping[RTL_TXQ_BE]	= rtlusb->out_eps[0];90		ep_map->ep_mapping[RTL_TXQ_BK]	= rtlusb->out_eps[1];91		ep_map->ep_mapping[RTL_TXQ_VI]	= rtlusb->out_eps[1];92		ep_map->ep_mapping[RTL_TXQ_VO]	= rtlusb->out_eps[0];93		ep_map->ep_mapping[RTL_TXQ_MGT] = rtlusb->out_eps[0];94		ep_map->ep_mapping[RTL_TXQ_BCN] = rtlusb->out_eps[0];95		ep_map->ep_mapping[RTL_TXQ_HI]	= rtlusb->out_eps[0];96	} else { /* typical setting */97		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG,98			"USB typical Setting.....\n");99		ep_map->ep_mapping[RTL_TXQ_BE]	= rtlusb->out_eps[1];100		ep_map->ep_mapping[RTL_TXQ_BK]	= rtlusb->out_eps[1];101		ep_map->ep_mapping[RTL_TXQ_VI]	= rtlusb->out_eps[0];102		ep_map->ep_mapping[RTL_TXQ_VO]	= rtlusb->out_eps[0];103		ep_map->ep_mapping[RTL_TXQ_MGT] = rtlusb->out_eps[0];104		ep_map->ep_mapping[RTL_TXQ_BCN] = rtlusb->out_eps[0];105		ep_map->ep_mapping[RTL_TXQ_HI]	= rtlusb->out_eps[0];106	}107}108 109static void threeoutepmapping(struct ieee80211_hw *hw, bool  bwificfg,110			       struct rtl_ep_map *ep_map)111{112	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);113	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);114	struct rtl_priv *rtlpriv = rtl_priv(hw);115 116	if (bwificfg) { /* for WMM */117		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG,118			"USB 3EP Setting for WMM.....\n");119		ep_map->ep_mapping[RTL_TXQ_BE]	= rtlusb->out_eps[2];120		ep_map->ep_mapping[RTL_TXQ_BK]	= rtlusb->out_eps[1];121		ep_map->ep_mapping[RTL_TXQ_VI]	= rtlusb->out_eps[1];122		ep_map->ep_mapping[RTL_TXQ_VO]	= rtlusb->out_eps[0];123		ep_map->ep_mapping[RTL_TXQ_MGT] = rtlusb->out_eps[0];124		ep_map->ep_mapping[RTL_TXQ_BCN] = rtlusb->out_eps[0];125		ep_map->ep_mapping[RTL_TXQ_HI]	= rtlusb->out_eps[0];126	} else { /* typical setting */127		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG,128			"USB 3EP Setting for typical.....\n");129		ep_map->ep_mapping[RTL_TXQ_BE]	= rtlusb->out_eps[2];130		ep_map->ep_mapping[RTL_TXQ_BK]	= rtlusb->out_eps[2];131		ep_map->ep_mapping[RTL_TXQ_VI]	= rtlusb->out_eps[1];132		ep_map->ep_mapping[RTL_TXQ_VO]	= rtlusb->out_eps[0];133		ep_map->ep_mapping[RTL_TXQ_MGT] = rtlusb->out_eps[0];134		ep_map->ep_mapping[RTL_TXQ_BCN] = rtlusb->out_eps[0];135		ep_map->ep_mapping[RTL_TXQ_HI]	= rtlusb->out_eps[0];136	}137}138 139static void oneoutepmapping(struct ieee80211_hw *hw, struct rtl_ep_map *ep_map)140{141	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);142	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);143 144	ep_map->ep_mapping[RTL_TXQ_BE]	= rtlusb->out_eps[0];145	ep_map->ep_mapping[RTL_TXQ_BK]	= rtlusb->out_eps[0];146	ep_map->ep_mapping[RTL_TXQ_VI]	= rtlusb->out_eps[0];147	ep_map->ep_mapping[RTL_TXQ_VO]	= rtlusb->out_eps[0];148	ep_map->ep_mapping[RTL_TXQ_MGT] = rtlusb->out_eps[0];149	ep_map->ep_mapping[RTL_TXQ_BCN] = rtlusb->out_eps[0];150	ep_map->ep_mapping[RTL_TXQ_HI]	= rtlusb->out_eps[0];151}152 153static int _out_ep_mapping(struct ieee80211_hw *hw)154{155	int err = 0;156	bool ischipn, bwificfg = false;157	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));158	struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);159	struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);160	struct rtl_ep_map *ep_map = &(rtlusb->ep_map);161 162	ischipn = IS_NORMAL_CHIP(rtlhal->version);163	switch (rtlusb->out_ep_nums) {164	case 2:165		twooutepmapping(hw, ischipn, bwificfg, ep_map);166		break;167	case 3:168		/* Test chip doesn't support three out EPs. */169		if (!ischipn) {170			err  =  -EINVAL;171			goto err_out;172		}173		threeoutepmapping(hw, ischipn, ep_map);174		break;175	case 1:176		oneoutepmapping(hw, ep_map);177		break;178	default:179		err  =  -EINVAL;180		break;181	}182err_out:183	return err;184 185}186 187/* endpoint mapping */188int  rtl8192cu_endpoint_mapping(struct ieee80211_hw *hw)189{190	struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));191	int error = 0;192 193	if (likely(IS_NORMAL_CHIP(rtlhal->version)))194		error = configvernoutep(hw);195	else196		error = configvertoutep(hw);197	if (error)198		goto err_out;199	error = _out_ep_mapping(hw);200	if (error)201		goto err_out;202err_out:203	return error;204}205 206u16 rtl8192cu_mq_to_hwq(__le16 fc, u16 mac80211_queue_index)207{208	u16 hw_queue_index;209 210	if (unlikely(ieee80211_is_beacon(fc))) {211		hw_queue_index = RTL_TXQ_BCN;212		goto out;213	}214	if (ieee80211_is_mgmt(fc)) {215		hw_queue_index = RTL_TXQ_MGT;216		goto out;217	}218	switch (mac80211_queue_index) {219	case 0:220		hw_queue_index = RTL_TXQ_VO;221		break;222	case 1:223		hw_queue_index = RTL_TXQ_VI;224		break;225	case 2:226		hw_queue_index = RTL_TXQ_BE;227		break;228	case 3:229		hw_queue_index = RTL_TXQ_BK;230		break;231	default:232		hw_queue_index = RTL_TXQ_BE;233		WARN_ONCE(true, "rtl8192cu: QSLT_BE queue, skb_queue:%d\n",234			  mac80211_queue_index);235		break;236	}237out:238	return hw_queue_index;239}240 241static enum rtl_desc_qsel _rtl8192cu_mq_to_descq(struct ieee80211_hw *hw,242					 __le16 fc, u16 mac80211_queue_index)243{244	enum rtl_desc_qsel qsel;245	struct rtl_priv *rtlpriv = rtl_priv(hw);246 247	if (unlikely(ieee80211_is_beacon(fc))) {248		qsel = QSLT_BEACON;249		goto out;250	}251	if (ieee80211_is_mgmt(fc)) {252		qsel = QSLT_MGNT;253		goto out;254	}255	switch (mac80211_queue_index) {256	case 0:	/* VO */257		qsel = QSLT_VO;258		rtl_dbg(rtlpriv, COMP_USB, DBG_DMESG,259			"VO queue, set qsel = 0x%x\n", QSLT_VO);260		break;261	case 1:	/* VI */262		qsel = QSLT_VI;263		rtl_dbg(rtlpriv, COMP_USB, DBG_DMESG,264			"VI queue, set qsel = 0x%x\n", QSLT_VI);265		break;266	case 3:	/* BK */267		qsel = QSLT_BK;268		rtl_dbg(rtlpriv, COMP_USB, DBG_DMESG,269			"BK queue, set qsel = 0x%x\n", QSLT_BK);270		break;271	case 2:	/* BE */272	default:273		qsel = QSLT_BE;274		rtl_dbg(rtlpriv, COMP_USB, DBG_DMESG,275			"BE queue, set qsel = 0x%x\n", QSLT_BE);276		break;277	}278out:279	return qsel;280}281 282/* =============================================================== */283 284/*----------------------------------------------------------------------285 *286 *	Rx handler287 *288 *---------------------------------------------------------------------- */289bool rtl92cu_rx_query_desc(struct ieee80211_hw *hw,290			   struct rtl_stats *stats,291			   struct ieee80211_rx_status *rx_status,292			   u8 *pdesc8, struct sk_buff *skb)293{294	struct rx_fwinfo_92c *p_drvinfo;295	struct rx_desc_92c *p_desc = (struct rx_desc_92c *)pdesc8;296	__le32 *pdesc = (__le32 *)pdesc8;297	u32 phystatus = get_rx_desc_phy_status(pdesc);298 299	stats->length = (u16)get_rx_desc_pkt_len(pdesc);300	stats->rx_drvinfo_size = (u8)get_rx_desc_drvinfo_size(pdesc) *301				 RX_DRV_INFO_SIZE_UNIT;302	stats->rx_bufshift = (u8)(get_rx_desc_shift(pdesc) & 0x03);303	stats->icv = (u16)get_rx_desc_icv(pdesc);304	stats->crc = (u16)get_rx_desc_crc32(pdesc);305	stats->hwerror = (stats->crc | stats->icv);306	stats->decrypted = !get_rx_desc_swdec(pdesc);307	stats->rate = (u8)get_rx_desc_rx_mcs(pdesc);308	stats->shortpreamble = (u16)get_rx_desc_splcp(pdesc);309	stats->isampdu = (bool)(get_rx_desc_paggr(pdesc) == 1);310	stats->isfirst_ampdu = (bool)((get_rx_desc_paggr(pdesc) == 1) &&311				      (get_rx_desc_faggr(pdesc) == 1));312	stats->timestamp_low = get_rx_desc_tsfl(pdesc);313	stats->rx_is40mhzpacket = (bool)get_rx_desc_bw(pdesc);314	stats->is_ht = (bool)get_rx_desc_rx_ht(pdesc);315	rx_status->freq = hw->conf.chandef.chan->center_freq;316	rx_status->band = hw->conf.chandef.chan->band;317	if (get_rx_desc_crc32(pdesc))318		rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;319	if (!get_rx_desc_swdec(pdesc))320		rx_status->flag |= RX_FLAG_DECRYPTED;321	if (get_rx_desc_bw(pdesc))322		rx_status->bw = RATE_INFO_BW_40;323	if (get_rx_desc_rx_ht(pdesc))324		rx_status->encoding = RX_ENC_HT;325	rx_status->flag |= RX_FLAG_MACTIME_START;326	if (stats->decrypted)327		rx_status->flag |= RX_FLAG_DECRYPTED;328	rx_status->rate_idx = rtlwifi_rate_mapping(hw, stats->is_ht,329						   false, stats->rate);330	rx_status->mactime = get_rx_desc_tsfl(pdesc);331	if (phystatus) {332		p_drvinfo = (struct rx_fwinfo_92c *)(skb->data +333						     stats->rx_bufshift);334		rtl92c_translate_rx_signal_stuff(hw, skb, stats, p_desc,335						 p_drvinfo);336	}337	/*rx_status->qual = stats->signal; */338	rx_status->signal = stats->recvsignalpower + 10;339	return true;340}341 342#define RTL_RX_DRV_INFO_UNIT		8343 344static void _rtl_rx_process(struct ieee80211_hw *hw, struct sk_buff *skb)345{346	struct ieee80211_rx_status *rx_status =347		 (struct ieee80211_rx_status *)IEEE80211_SKB_RXCB(skb);348	u32 skb_len, pkt_len, drvinfo_len;349	struct rtl_priv *rtlpriv = rtl_priv(hw);350	__le32 *rxdesc;351	struct rtl_stats stats = {352		.signal = 0,353		.rate = 0,354	};355	struct rx_fwinfo_92c *p_drvinfo;356	bool bv;357	__le16 fc;358	struct ieee80211_hdr *hdr;359 360	memset(rx_status, 0, sizeof(*rx_status));361	rxdesc	= (__le32 *)skb->data;362	skb_len	= skb->len;363	drvinfo_len = (get_rx_desc_drvinfo_size(rxdesc) * RTL_RX_DRV_INFO_UNIT);364	pkt_len		= get_rx_desc_pkt_len(rxdesc);365	/* TODO: Error recovery. drop this skb or something. */366	WARN_ON(skb_len < (pkt_len + RTL_RX_DESC_SIZE + drvinfo_len));367	stats.length = (u16)get_rx_desc_pkt_len(rxdesc);368	stats.rx_drvinfo_size = (u8)get_rx_desc_drvinfo_size(rxdesc) *369				RX_DRV_INFO_SIZE_UNIT;370	stats.rx_bufshift = (u8)(get_rx_desc_shift(rxdesc) & 0x03);371	stats.icv = (u16)get_rx_desc_icv(rxdesc);372	stats.crc = (u16)get_rx_desc_crc32(rxdesc);373	stats.hwerror = (stats.crc | stats.icv);374	stats.decrypted = !get_rx_desc_swdec(rxdesc);375	stats.rate = (u8)get_rx_desc_rx_mcs(rxdesc);376	stats.shortpreamble = (u16)get_rx_desc_splcp(rxdesc);377	stats.isampdu = (bool)((get_rx_desc_paggr(rxdesc) == 1) &&378			       (get_rx_desc_faggr(rxdesc) == 1));379	stats.timestamp_low = get_rx_desc_tsfl(rxdesc);380	stats.rx_is40mhzpacket = (bool)get_rx_desc_bw(rxdesc);381	stats.is_ht = (bool)get_rx_desc_rx_ht(rxdesc);382	/* TODO: is center_freq changed when doing scan? */383	/* TODO: Shall we add protection or just skip those two step? */384	rx_status->freq = hw->conf.chandef.chan->center_freq;385	rx_status->band = hw->conf.chandef.chan->band;386	if (get_rx_desc_crc32(rxdesc))387		rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;388	if (!get_rx_desc_swdec(rxdesc))389		rx_status->flag |= RX_FLAG_DECRYPTED;390	if (get_rx_desc_bw(rxdesc))391		rx_status->bw = RATE_INFO_BW_40;392	if (get_rx_desc_rx_ht(rxdesc))393		rx_status->encoding = RX_ENC_HT;394	/* Data rate */395	rx_status->rate_idx = rtlwifi_rate_mapping(hw, stats.is_ht,396						   false, stats.rate);397	/*  There is a phy status after this rx descriptor. */398	if (get_rx_desc_phy_status(rxdesc)) {399		p_drvinfo = (struct rx_fwinfo_92c *)(rxdesc + RTL_RX_DESC_SIZE);400		rtl92c_translate_rx_signal_stuff(hw, skb, &stats,401				 (struct rx_desc_92c *)rxdesc, p_drvinfo);402	}403	skb_pull(skb, (drvinfo_len + RTL_RX_DESC_SIZE));404	hdr = rtl_get_hdr(skb);405	fc = hdr->frame_control;406	bv = ieee80211_is_probe_resp(fc);407	if (bv)408		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG,409			"Got probe response frame\n");410	if (ieee80211_is_beacon(fc))411		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG, "Got beacon frame\n");412	if (ieee80211_is_data(fc))413		rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG, "Got data frame\n");414	rtl_dbg(rtlpriv, COMP_INIT, DBG_DMESG,415		"Fram: fc = 0x%X addr1 = 0x%02X:0x%02X:0x%02X:0x%02X:0x%02X:0x%02X\n",416		fc,417		(u32)hdr->addr1[0], (u32)hdr->addr1[1],418		(u32)hdr->addr1[2], (u32)hdr->addr1[3],419		(u32)hdr->addr1[4], (u32)hdr->addr1[5]);420	ieee80211_rx(hw, skb);421}422 423void  rtl8192cu_rx_hdl(struct ieee80211_hw *hw, struct sk_buff * skb)424{425	_rtl_rx_process(hw, skb);426}427 428/*----------------------------------------------------------------------429 *430 *	Tx handler431 *432 *---------------------------------------------------------------------- */433void rtl8192c_tx_cleanup(struct ieee80211_hw *hw, struct sk_buff  *skb)434{435}436 437int rtl8192c_tx_post_hdl(struct ieee80211_hw *hw, struct urb *urb,438			 struct sk_buff *skb)439{440	return 0;441}442 443struct sk_buff *rtl8192c_tx_aggregate_hdl(struct ieee80211_hw *hw,444					   struct sk_buff_head *list)445{446	return skb_dequeue(list);447}448 449/*======================================== trx ===============================*/450 451static void _rtl_fill_usb_tx_desc(__le32 *txdesc)452{453	set_tx_desc_own(txdesc, 1);454	set_tx_desc_last_seg(txdesc, 1);455	set_tx_desc_first_seg(txdesc, 1);456}457 458/*459 *	For HW recovery information460 */461static void _rtl_tx_desc_checksum(__le32 *txdesc)462{463	__le16 *ptr = (__le16 *)txdesc;464	u16	checksum = 0;465	u32 index;466 467	/* Clear first */468	set_tx_desc_tx_desc_checksum(txdesc, 0);469	for (index = 0; index < 16; index++)470		checksum = checksum ^ le16_to_cpu(*(ptr + index));471	set_tx_desc_tx_desc_checksum(txdesc, checksum);472}473 474void rtl92cu_tx_fill_desc(struct ieee80211_hw *hw,475			  struct ieee80211_hdr *hdr, u8 *pdesc_tx,476			  u8 *pbd_desc_tx, struct ieee80211_tx_info *info,477			  struct ieee80211_sta *sta,478			  struct sk_buff *skb,479			  u8 queue_index,480			  struct rtl_tcb_desc *tcb_desc)481{482	struct rtl_priv *rtlpriv = rtl_priv(hw);483	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));484	struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));485	struct rtl_sta_info *sta_entry;486	u8 agg_state = RTL_AGG_STOP;487	u8 ampdu_density = 0;488	u16 seq_number;489	__le16 fc = hdr->frame_control;490	u8 rate_flag = info->control.rates[0].flags;491	u16 pktlen = skb->len;492	enum rtl_desc_qsel fw_qsel = _rtl8192cu_mq_to_descq(hw, fc,493						skb_get_queue_mapping(skb));494	u8 *txdesc8;495	__le32 *txdesc;496	u8 tid;497 498	seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;499	rtl_get_tcb_desc(hw, info, sta, skb, tcb_desc);500	txdesc8 = skb_push(skb, RTL_TX_HEADER_SIZE);501	txdesc = (__le32 *)txdesc8;502	memset(txdesc, 0, RTL_TX_HEADER_SIZE);503	set_tx_desc_pkt_size(txdesc, pktlen);504	set_tx_desc_linip(txdesc, 0);505	set_tx_desc_pkt_offset(txdesc, RTL_DUMMY_OFFSET);506	set_tx_desc_offset(txdesc, RTL_TX_HEADER_SIZE);507	set_tx_desc_tx_rate(txdesc, tcb_desc->hw_rate);508	if (tcb_desc->use_shortgi || tcb_desc->use_shortpreamble)509		set_tx_desc_data_shortgi(txdesc, 1);510 511	if (sta) {512		sta_entry = (struct rtl_sta_info *)sta->drv_priv;513		tid = ieee80211_get_tid(hdr);514		agg_state = sta_entry->tids[tid].agg.agg_state;515		ampdu_density = sta->deflink.ht_cap.ampdu_density;516	}517 518	if (agg_state == RTL_AGG_OPERATIONAL &&519	    info->flags & IEEE80211_TX_CTL_AMPDU) {520		set_tx_desc_agg_enable(txdesc, 1);521		set_tx_desc_max_agg_num(txdesc, 0x14);522		set_tx_desc_ampdu_density(txdesc, ampdu_density);523		tcb_desc->rts_enable = 1;524		tcb_desc->rts_rate = DESC_RATE24M;525	} else {526		set_tx_desc_agg_break(txdesc, 1);527	}528	set_tx_desc_seq(txdesc, seq_number);529	set_tx_desc_rts_enable(txdesc,530			       ((tcb_desc->rts_enable &&531				!tcb_desc->cts_enable) ? 1 : 0));532	set_tx_desc_hw_rts_enable(txdesc,533				  ((tcb_desc->rts_enable ||534				   tcb_desc->cts_enable) ? 1 : 0));535	set_tx_desc_cts2self(txdesc, ((tcb_desc->cts_enable) ? 1 : 0));536	set_tx_desc_rts_stbc(txdesc, ((tcb_desc->rts_stbc) ? 1 : 0));537	set_tx_desc_rts_rate(txdesc, tcb_desc->rts_rate);538	set_tx_desc_rts_bw(txdesc, 0);539	set_tx_desc_rts_sc(txdesc, tcb_desc->rts_sc);540	set_tx_desc_rts_short(txdesc,541			      ((tcb_desc->rts_rate <= DESC_RATE54M) ?542			       (tcb_desc->rts_use_shortpreamble ? 1 : 0)543			       : (tcb_desc->rts_use_shortgi ? 1 : 0)));544	if (mac->bw_40) {545		if (rate_flag & IEEE80211_TX_RC_DUP_DATA) {546			set_tx_desc_data_bw(txdesc, 1);547			set_tx_desc_data_sc(txdesc, 3);548		} else if(rate_flag & IEEE80211_TX_RC_40_MHZ_WIDTH){549			set_tx_desc_data_bw(txdesc, 1);550			set_tx_desc_data_sc(txdesc, mac->cur_40_prime_sc);551		} else {552			set_tx_desc_data_bw(txdesc, 0);553			set_tx_desc_data_sc(txdesc, 0);554		}555	} else {556		set_tx_desc_data_bw(txdesc, 0);557		set_tx_desc_data_sc(txdesc, 0);558	}559	if (info->control.hw_key) {560		struct ieee80211_key_conf *keyconf = info->control.hw_key;561 562		switch (keyconf->cipher) {563		case WLAN_CIPHER_SUITE_WEP40:564		case WLAN_CIPHER_SUITE_WEP104:565		case WLAN_CIPHER_SUITE_TKIP:566			set_tx_desc_sec_type(txdesc, 0x1);567			break;568		case WLAN_CIPHER_SUITE_CCMP:569			set_tx_desc_sec_type(txdesc, 0x3);570			break;571		default:572			set_tx_desc_sec_type(txdesc, 0x0);573			break;574		}575	}576	set_tx_desc_pkt_id(txdesc, 0);577	set_tx_desc_queue_sel(txdesc, fw_qsel);578	set_tx_desc_data_rate_fb_limit(txdesc, 0x1F);579	set_tx_desc_rts_rate_fb_limit(txdesc, 0xF);580	set_tx_desc_disable_fb(txdesc, 0);581	set_tx_desc_use_rate(txdesc, tcb_desc->use_driver_rate ? 1 : 0);582	if (ieee80211_is_data_qos(fc)) {583		if (mac->rdg_en) {584			rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE,585				"Enable RDG function\n");586			set_tx_desc_rdg_enable(txdesc, 1);587			set_tx_desc_htc(txdesc, 1);588		}589	}590	if (rtlpriv->dm.useramask) {591		set_tx_desc_rate_id(txdesc, tcb_desc->ratr_index);592		set_tx_desc_macid(txdesc, tcb_desc->mac_id);593	} else {594		set_tx_desc_rate_id(txdesc, 0xC + tcb_desc->ratr_index);595		set_tx_desc_macid(txdesc, tcb_desc->ratr_index);596	}597	if ((!ieee80211_is_data_qos(fc)) && ppsc->leisure_ps &&598	      ppsc->fwctrl_lps) {599		set_tx_desc_hwseq_en(txdesc, 1);600		set_tx_desc_pkt_id(txdesc, 8);601	}602	if (ieee80211_has_morefrags(fc))603		set_tx_desc_more_frag(txdesc, 1);604	if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) ||605	    is_broadcast_ether_addr(ieee80211_get_DA(hdr)))606		set_tx_desc_bmc(txdesc, 1);607	_rtl_fill_usb_tx_desc(txdesc);608	_rtl_tx_desc_checksum(txdesc);609	rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, "==>\n");610}611 612void rtl92cu_tx_fill_cmddesc(struct ieee80211_hw *hw, u8 *pdesc8,613			     struct sk_buff *skb)614{615	struct rtl_priv *rtlpriv = rtl_priv(hw);616	u8 fw_queue = QSLT_BEACON;617	struct ieee80211_hdr *hdr = rtl_get_hdr(skb);618	__le16 fc = hdr->frame_control;619	__le32 *pdesc = (__le32 *)pdesc8;620 621	memset((void *)pdesc, 0, RTL_TX_HEADER_SIZE);622	set_tx_desc_offset(pdesc, RTL_TX_HEADER_SIZE);623	set_tx_desc_tx_rate(pdesc, DESC_RATE1M);624	set_tx_desc_seq(pdesc, 0);625	set_tx_desc_linip(pdesc, 0);626	set_tx_desc_queue_sel(pdesc, fw_queue);627	set_tx_desc_first_seg(pdesc, 1);628	set_tx_desc_last_seg(pdesc, 1);629	set_tx_desc_rate_id(pdesc, 7);630	set_tx_desc_macid(pdesc, 0);631	set_tx_desc_own(pdesc, 1);632	set_tx_desc_pkt_size(pdesc, (u16)skb->len);633	set_tx_desc_first_seg(pdesc, 1);634	set_tx_desc_last_seg(pdesc, 1);635	set_tx_desc_offset(pdesc, 0x20);636	set_tx_desc_use_rate(pdesc, 1);637	if (!ieee80211_is_data_qos(fc)) {638		set_tx_desc_hwseq_en(pdesc, 1);639		set_tx_desc_pkt_id(pdesc, 8);640	}641	RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD, "H2C Tx Cmd Content",642		      pdesc, RTL_TX_DESC_SIZE);643}644