1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright(c) 2009-2013  Realtek Corporation.*/
3 
4 #include "../wifi.h"
5 #include "../pci.h"
6 #include "../base.h"
7 #include "../stats.h"
8 #include "reg.h"
9 #include "def.h"
10 #include "trx.h"
11 #include "led.h"
12 #include "dm.h"
13 #include "phy.h"
14 
15 static u8 _rtl88ee_map_hwqueue_to_fwqueue(struct sk_buff *skb, u8 hw_queue)
16 {
17 	__le16 fc = rtl_get_fc(skb);
18 
19 	if (unlikely(ieee80211_is_beacon(fc)))
20 		return QSLT_BEACON;
21 	if (ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))
22 		return QSLT_MGNT;
23 
24 	return skb->priority;
25 }
26 
27 static void _rtl88ee_query_rxphystatus(struct ieee80211_hw *hw,
28 			struct rtl_stats *pstatus, __le32 *pdesc,
29 			struct rx_fwinfo_88e *p_drvinfo,
30 			bool bpacket_match_bssid,
31 			bool bpacket_toself, bool packet_beacon)
32 {
33 	struct rtl_priv *rtlpriv = rtl_priv(hw);
34 	struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv);
35 	struct phy_sts_cck_8192s_t *cck_buf;
36 	struct phy_status_rpt *phystrpt =
37 		(struct phy_status_rpt *)p_drvinfo;
38 	struct rtl_dm *rtldm = rtl_dm(rtl_priv(hw));
39 	s8 rx_pwr_all = 0, rx_pwr[4];
40 	u8 rf_rx_num = 0, evm, pwdb_all;
41 	u8 i, max_spatial_stream;
42 	u32 rssi, total_rssi = 0;
43 	bool is_cck = pstatus->is_cck;
44 	u8 lan_idx, vga_idx;
45 
46 	/* Record it for next packet processing */
47 	pstatus->packet_matchbssid = bpacket_match_bssid;
48 	pstatus->packet_toself = bpacket_toself;
49 	pstatus->packet_beacon = packet_beacon;
50 	pstatus->rx_mimo_signalquality[0] = -1;
51 	pstatus->rx_mimo_signalquality[1] = -1;
52 
53 	if (is_cck) {
54 		u8 cck_highpwr;
55 		u8 cck_agc_rpt;
56 		/* CCK Driver info Structure is not the same as OFDM packet. */
57 		cck_buf = (struct phy_sts_cck_8192s_t *)p_drvinfo;
58 		cck_agc_rpt = cck_buf->cck_agc_rpt;
59 
60 		/* (1)Hardware does not provide RSSI for CCK
61 		 * (2)PWDB, Average PWDB cacluated by
62 		 * hardware (for rate adaptive)
63 		 */
64 		if (ppsc->rfpwr_state == ERFON)
65 			cck_highpwr =
66 				(u8)rtl_get_bbreg(hw, RFPGA0_XA_HSSIPARAMETER2,
67 						  BIT(9));
68 		else
69 			cck_highpwr = false;
70 
71 		lan_idx = ((cck_agc_rpt & 0xE0) >> 5);
72 		vga_idx = (cck_agc_rpt & 0x1f);
73 		switch (lan_idx) {
74 		case 7:
75 			if (vga_idx <= 27)
76 				/*VGA_idx = 27~2*/
77 				rx_pwr_all = -100 + 2*(27-vga_idx);
78 			else
79 				rx_pwr_all = -100;
80 			break;
81 		case 6:
82 			/*VGA_idx = 2~0*/
83 			rx_pwr_all = -48 + 2*(2-vga_idx);
84 			break;
85 		case 5:
86 			/*VGA_idx = 7~5*/
87 			rx_pwr_all = -42 + 2*(7-vga_idx);
88 			break;
89 		case 4:
90 			/*VGA_idx = 7~4*/
91 			rx_pwr_all = -36 + 2*(7-vga_idx);
92 			break;
93 		case 3:
94 			/*VGA_idx = 7~0*/
95 			rx_pwr_all = -24 + 2*(7-vga_idx);
96 			break;
97 		case 2:
98 			if (cck_highpwr)
99 				/*VGA_idx = 5~0*/
100 				rx_pwr_all = -12 + 2*(5-vga_idx);
101 			else
102 				rx_pwr_all = -6 + 2*(5-vga_idx);
103 			break;
104 		case 1:
105 			rx_pwr_all = 8-2*vga_idx;
106 			break;
107 		case 0:
108 			rx_pwr_all = 14-2*vga_idx;
109 			break;
110 		default:
111 			break;
112 		}
113 		rx_pwr_all += 6;
114 		pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all);
115 		/* CCK gain is smaller than OFDM/MCS gain,  */
116 		/* so we add gain diff by experiences, the val is 6 */
117 		pwdb_all += 6;
118 		if (pwdb_all > 100)
119 			pwdb_all = 100;
120 		/* modify the offset to make the same
121 		 * gain index with OFDM.
122 		 */
123 		if (pwdb_all > 34 && pwdb_all <= 42)
124 			pwdb_all -= 2;
125 		else if (pwdb_all > 26 && pwdb_all <= 34)
126 			pwdb_all -= 6;
127 		else if (pwdb_all > 14 && pwdb_all <= 26)
128 			pwdb_all -= 8;
129 		else if (pwdb_all > 4 && pwdb_all <= 14)
130 			pwdb_all -= 4;
131 		if (!cck_highpwr) {
132 			if (pwdb_all >= 80)
133 				pwdb_all = ((pwdb_all-80)<<1) +
134 					   ((pwdb_all-80)>>1) + 80;
135 			else if ((pwdb_all <= 78) && (pwdb_all >= 20))
136 				pwdb_all += 3;
137 			if (pwdb_all > 100)
138 				pwdb_all = 100;
139 		}
140 
141 		pstatus->rx_pwdb_all = pwdb_all;
142 		pstatus->recvsignalpower = rx_pwr_all;
143 
144 		/* (3) Get Signal Quality (EVM) */
145 		if (bpacket_match_bssid) {
146 			u8 sq;
147 
148 			if (pstatus->rx_pwdb_all > 40)
149 				sq = 100;
150 			else {
151 				sq = cck_buf->sq_rpt;
152 				if (sq > 64)
153 					sq = 0;
154 				else if (sq < 20)
155 					sq = 100;
156 				else
157 					sq = ((64 - sq) * 100) / 44;
158 			}
159 
160 			pstatus->signalquality = sq;
161 			pstatus->rx_mimo_signalquality[0] = sq;
162 			pstatus->rx_mimo_signalquality[1] = -1;
163 		}
164 	} else {
165 		rtlpriv->dm.rfpath_rxenable[0] =
166 		    rtlpriv->dm.rfpath_rxenable[1] = true;
167 
168 		/* (1)Get RSSI for HT rate */
169 		for (i = RF90_PATH_A; i < RF6052_MAX_PATH; i++) {
170 			/* we will judge RF RX path now. */
171 			if (rtlpriv->dm.rfpath_rxenable[i])
172 				rf_rx_num++;
173 
174 			rx_pwr[i] = ((p_drvinfo->gain_trsw[i] &
175 				      0x3f) * 2) - 110;
176 
177 			/* Translate DBM to percentage. */
178 			rssi = rtl_query_rxpwrpercentage(rx_pwr[i]);
179 			total_rssi += rssi;
180 
181 			/* Get Rx snr value in DB */
182 			rtlpriv->stats.rx_snr_db[i] =
183 				(long)(p_drvinfo->rxsnr[i] / 2);
184 
185 			/* Record Signal Strength for next packet */
186 			if (bpacket_match_bssid)
187 				pstatus->rx_mimo_signalstrength[i] = (u8)rssi;
188 		}
189 
190 		/* (2)PWDB, Average PWDB cacluated by
191 		 * hardware (for rate adaptive)
192 		 */
193 		rx_pwr_all = ((p_drvinfo->pwdb_all >> 1) & 0x7f) - 110;
194 
195 		pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all);
196 		pstatus->rx_pwdb_all = pwdb_all;
197 		pstatus->rxpower = rx_pwr_all;
198 		pstatus->recvsignalpower = rx_pwr_all;
199 
200 		/* (3)EVM of HT rate */
201 		if (pstatus->is_ht && pstatus->rate >= DESC92C_RATEMCS8 &&
202 		    pstatus->rate <= DESC92C_RATEMCS15)
203 			max_spatial_stream = 2;
204 		else
205 			max_spatial_stream = 1;
206 
207 		for (i = 0; i < max_spatial_stream; i++) {
208 			evm = rtl_evm_db_to_percentage(p_drvinfo->rxevm[i]);
209 
210 			if (bpacket_match_bssid) {
211 				/* Fill value in RFD, Get the first
212 				 * spatial stream onlyi
213 				 */
214 				if (i == 0)
215 					pstatus->signalquality =
216 						(u8)(evm & 0xff);
217 				pstatus->rx_mimo_signalquality[i] =
218 					(u8)(evm & 0xff);
219 			}
220 		}
221 	}
222 
223 	/* UI BSS List signal strength(in percentage),
224 	 * make it good looking, from 0~100.
225 	 */
226 	if (is_cck)
227 		pstatus->signalstrength = (u8)(rtl_signal_scale_mapping(hw,
228 			pwdb_all));
229 	else if (rf_rx_num != 0)
230 		pstatus->signalstrength = (u8)(rtl_signal_scale_mapping(hw,
231 			total_rssi /= rf_rx_num));
232 	/*HW antenna diversity*/
233 	rtldm->fat_table.antsel_rx_keep_0 = phystrpt->ant_sel;
234 	rtldm->fat_table.antsel_rx_keep_1 = phystrpt->ant_sel_b;
235 	rtldm->fat_table.antsel_rx_keep_2 = phystrpt->antsel_rx_keep_2;
236 }
237 
238 static void _rtl88ee_smart_antenna(struct ieee80211_hw *hw,
239 	struct rtl_stats *pstatus)
240 {
241 	struct rtl_dm *rtldm = rtl_dm(rtl_priv(hw));
242 	struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
243 	u8 antsel_tr_mux;
244 	struct fast_ant_training *pfat_table = &rtldm->fat_table;
245 
246 	if (rtlefuse->antenna_div_type == CG_TRX_SMART_ANTDIV) {
247 		if (pfat_table->fat_state == FAT_TRAINING_STATE) {
248 			if (pstatus->packet_toself) {
249 				antsel_tr_mux =
250 					(pfat_table->antsel_rx_keep_2 << 2) |
251 					(pfat_table->antsel_rx_keep_1 << 1) |
252 					pfat_table->antsel_rx_keep_0;
253 				pfat_table->ant_sum[antsel_tr_mux] +=
254 					pstatus->rx_pwdb_all;
255 				pfat_table->ant_cnt[antsel_tr_mux]++;
256 			}
257 		}
258 	} else if ((rtlefuse->antenna_div_type == CG_TRX_HW_ANTDIV) ||
259 	(rtlefuse->antenna_div_type == CGCS_RX_HW_ANTDIV)) {
260 		if (pstatus->packet_toself || pstatus->packet_matchbssid) {
261 			antsel_tr_mux = (pfat_table->antsel_rx_keep_2 << 2) |
262 					(pfat_table->antsel_rx_keep_1 << 1) |
263 					pfat_table->antsel_rx_keep_0;
264 			rtl88e_dm_ant_sel_statistics(hw, antsel_tr_mux, 0,
265 						     pstatus->rx_pwdb_all);
266 		}
267 
268 	}
269 }
270 
271 static void _rtl88ee_translate_rx_signal_stuff(struct ieee80211_hw *hw,
272 					       struct sk_buff *skb,
273 					       struct rtl_stats *pstatus,
274 					       __le32 *pdesc,
275 					       struct rx_fwinfo_88e *p_drvinfo)
276 {
277 	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
278 	struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
279 	struct ieee80211_hdr *hdr;
280 	u8 *tmp_buf;
281 	u8 *praddr;
282 	u8 *psaddr;
283 	__le16 fc;
284 	bool packet_matchbssid, packet_toself, packet_beacon;
285 
286 	tmp_buf = skb->data + pstatus->rx_drvinfo_size + pstatus->rx_bufshift;
287 
288 	hdr = (struct ieee80211_hdr *)tmp_buf;
289 	fc = hdr->frame_control;
290 	praddr = hdr->addr1;
291 	psaddr = ieee80211_get_SA(hdr);
292 	memcpy(pstatus->psaddr, psaddr, ETH_ALEN);
293 
294 	packet_matchbssid = ((!ieee80211_is_ctl(fc)) &&
295 	     (ether_addr_equal(mac->bssid, ieee80211_has_tods(fc) ?
296 			       hdr->addr1 : ieee80211_has_fromds(fc) ?
297 			       hdr->addr2 : hdr->addr3)) &&
298 			       (!pstatus->hwerror) &&
299 			       (!pstatus->crc) && (!pstatus->icv));
300 
301 	packet_toself = packet_matchbssid &&
302 	    (ether_addr_equal(praddr, rtlefuse->dev_addr));
303 
304 	if (ieee80211_is_beacon(hdr->frame_control))
305 		packet_beacon = true;
306 	else
307 		packet_beacon = false;
308 
309 	_rtl88ee_query_rxphystatus(hw, pstatus, pdesc, p_drvinfo,
310 				   packet_matchbssid, packet_toself,
311 				   packet_beacon);
312 	_rtl88ee_smart_antenna(hw, pstatus);
313 	rtl_process_phyinfo(hw, tmp_buf, pstatus);
314 }
315 
316 static void rtl88ee_insert_emcontent(struct rtl_tcb_desc *ptcb_desc,
317 				     __le32 *virtualaddress)
318 {
319 	u32 dwtmp = 0;
320 	memset(virtualaddress, 0, 8);
321 
322 	set_earlymode_pktnum(virtualaddress, ptcb_desc->empkt_num);
323 	if (ptcb_desc->empkt_num == 1) {
324 		dwtmp = ptcb_desc->empkt_len[0];
325 	} else {
326 		dwtmp = ptcb_desc->empkt_len[0];
327 		dwtmp += ((dwtmp%4) ? (4-dwtmp%4) : 0)+4;
328 		dwtmp += ptcb_desc->empkt_len[1];
329 	}
330 	set_earlymode_len0(virtualaddress, dwtmp);
331 
332 	if (ptcb_desc->empkt_num <= 3) {
333 		dwtmp = ptcb_desc->empkt_len[2];
334 	} else {
335 		dwtmp = ptcb_desc->empkt_len[2];
336 		dwtmp += ((dwtmp%4) ? (4-dwtmp%4) : 0)+4;
337 		dwtmp += ptcb_desc->empkt_len[3];
338 	}
339 	set_earlymode_len1(virtualaddress, dwtmp);
340 	if (ptcb_desc->empkt_num <= 5) {
341 		dwtmp = ptcb_desc->empkt_len[4];
342 	} else {
343 		dwtmp = ptcb_desc->empkt_len[4];
344 		dwtmp += ((dwtmp%4) ? (4-dwtmp%4) : 0)+4;
345 		dwtmp += ptcb_desc->empkt_len[5];
346 	}
347 	set_earlymode_len2_1(virtualaddress, dwtmp & 0xF);
348 	set_earlymode_len2_2(virtualaddress, dwtmp >> 4);
349 	if (ptcb_desc->empkt_num <= 7) {
350 		dwtmp = ptcb_desc->empkt_len[6];
351 	} else {
352 		dwtmp = ptcb_desc->empkt_len[6];
353 		dwtmp += ((dwtmp%4) ? (4-dwtmp%4) : 0)+4;
354 		dwtmp += ptcb_desc->empkt_len[7];
355 	}
356 	set_earlymode_len3(virtualaddress, dwtmp);
357 	if (ptcb_desc->empkt_num <= 9) {
358 		dwtmp = ptcb_desc->empkt_len[8];
359 	} else {
360 		dwtmp = ptcb_desc->empkt_len[8];
361 		dwtmp += ((dwtmp%4) ? (4-dwtmp%4) : 0)+4;
362 		dwtmp += ptcb_desc->empkt_len[9];
363 	}
364 	set_earlymode_len4(virtualaddress, dwtmp);
365 }
366 
367 bool rtl88ee_rx_query_desc(struct ieee80211_hw *hw,
368 			   struct rtl_stats *status,
369 			   struct ieee80211_rx_status *rx_status,
370 			   u8 *pdesc8, struct sk_buff *skb)
371 {
372 	struct rtl_priv *rtlpriv = rtl_priv(hw);
373 	struct rx_fwinfo_88e *p_drvinfo;
374 	struct ieee80211_hdr *hdr;
375 	u8 wake_match;
376 	__le32 *pdesc = (__le32 *)pdesc8;
377 	u32 phystatus = get_rx_desc_physt(pdesc);
378 
379 	status->packet_report_type = (u8)get_rx_status_desc_rpt_sel(pdesc);
380 	if (status->packet_report_type == TX_REPORT2)
381 		status->length = (u16)get_rx_rpt2_desc_pkt_len(pdesc);
382 	else
383 		status->length = (u16)get_rx_desc_pkt_len(pdesc);
384 	status->rx_drvinfo_size = (u8)get_rx_desc_drv_info_size(pdesc) *
385 	    RX_DRV_INFO_SIZE_UNIT;
386 	status->rx_bufshift = (u8)(get_rx_desc_shift(pdesc) & 0x03);
387 	status->icv = (u16)get_rx_desc_icv(pdesc);
388 	status->crc = (u16)get_rx_desc_crc32(pdesc);
389 	status->hwerror = (status->crc | status->icv);
390 	status->decrypted = !get_rx_desc_swdec(pdesc);
391 	status->rate = (u8)get_rx_desc_rxmcs(pdesc);
392 	status->shortpreamble = (u16)get_rx_desc_splcp(pdesc);
393 	status->isampdu = (bool) (get_rx_desc_paggr(pdesc) == 1);
394 	status->isfirst_ampdu = (bool)((get_rx_desc_paggr(pdesc) == 1) &&
395 				(get_rx_desc_faggr(pdesc) == 1));
396 	if (status->packet_report_type == NORMAL_RX)
397 		status->timestamp_low = get_rx_desc_tsfl(pdesc);
398 	status->rx_is40mhzpacket = (bool)get_rx_desc_bw(pdesc);
399 	status->is_ht = (bool)get_rx_desc_rxht(pdesc);
400 
401 	status->is_cck = RTL8188_RX_HAL_IS_CCK_RATE(status->rate);
402 
403 	status->macid = get_rx_desc_macid(pdesc);
404 	if (get_rx_status_desc_pattern_match(pdesc))
405 		wake_match = BIT(2);
406 	else if (get_rx_status_desc_magic_match(pdesc))
407 		wake_match = BIT(1);
408 	else if (get_rx_status_desc_unicast_match(pdesc))
409 		wake_match = BIT(0);
410 	else
411 		wake_match = 0;
412 	if (wake_match)
413 		rtl_dbg(rtlpriv, COMP_RXDESC, DBG_LOUD,
414 			"GGGGGGGGGGGGGet Wakeup Packet!! WakeMatch=%d\n",
415 			wake_match);
416 	rx_status->freq = hw->conf.chandef.chan->center_freq;
417 	rx_status->band = hw->conf.chandef.chan->band;
418 
419 	hdr = (struct ieee80211_hdr *)(skb->data + status->rx_drvinfo_size
420 			+ status->rx_bufshift);
421 
422 	if (status->crc)
423 		rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
424 
425 	if (status->rx_is40mhzpacket)
426 		rx_status->bw = RATE_INFO_BW_40;
427 
428 	if (status->is_ht)
429 		rx_status->encoding = RX_ENC_HT;
430 
431 	rx_status->flag |= RX_FLAG_MACTIME_START;
432 
433 	/* hw will set status->decrypted true, if it finds the
434 	 * frame is open data frame or mgmt frame.
435 	 * So hw will not decryption robust managment frame
436 	 * for IEEE80211w but still set status->decrypted
437 	 * true, so here we should set it back to undecrypted
438 	 * for IEEE80211w frame, and mac80211 sw will help
439 	 * to decrypt it
440 	 */
441 	if (status->decrypted) {
442 		if ((!_ieee80211_is_robust_mgmt_frame(hdr)) &&
443 		    (ieee80211_has_protected(hdr->frame_control)))
444 			rx_status->flag |= RX_FLAG_DECRYPTED;
445 		else
446 			rx_status->flag &= ~RX_FLAG_DECRYPTED;
447 	}
448 
449 	/* rate_idx: index of data rate into band's
450 	 * supported rates or MCS index if HT rates
451 	 * are use (RX_FLAG_HT)
452 	 * Notice: this is diff with windows define
453 	 */
454 	rx_status->rate_idx = rtlwifi_rate_mapping(hw, status->is_ht,
455 						   false, status->rate);
456 
457 	rx_status->mactime = status->timestamp_low;
458 	if (phystatus == true) {
459 		p_drvinfo = (struct rx_fwinfo_88e *)(skb->data +
460 						     status->rx_bufshift);
461 
462 		_rtl88ee_translate_rx_signal_stuff(hw,
463 						   skb, status, pdesc,
464 						   p_drvinfo);
465 	}
466 	rx_status->signal = status->recvsignalpower + 10;
467 	if (status->packet_report_type == TX_REPORT2) {
468 		status->macid_valid_entry[0] =
469 			 get_rx_rpt2_desc_macid_valid_1(pdesc);
470 		status->macid_valid_entry[1] =
471 			 get_rx_rpt2_desc_macid_valid_2(pdesc);
472 	}
473 	return true;
474 }
475 
476 void rtl88ee_tx_fill_desc(struct ieee80211_hw *hw,
477 			  struct ieee80211_hdr *hdr, u8 *pdesc8,
478 			  u8 *txbd, struct ieee80211_tx_info *info,
479 			  struct ieee80211_sta *sta,
480 			  struct sk_buff *skb,
481 			  u8 hw_queue, struct rtl_tcb_desc *ptcb_desc)
482 
483 {
484 	struct rtl_priv *rtlpriv = rtl_priv(hw);
485 	struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
486 	struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
487 	struct rtl_hal *rtlhal = rtl_hal(rtlpriv);
488 	u16 seq_number;
489 	__le16 fc = hdr->frame_control;
490 	unsigned int buf_len = 0;
491 	unsigned int skb_len = skb->len;
492 	u8 fw_qsel = _rtl88ee_map_hwqueue_to_fwqueue(skb, hw_queue);
493 	bool firstseg = ((hdr->seq_ctrl &
494 			    cpu_to_le16(IEEE80211_SCTL_FRAG)) == 0);
495 	bool lastseg = ((hdr->frame_control &
496 			   cpu_to_le16(IEEE80211_FCTL_MOREFRAGS)) == 0);
497 	dma_addr_t mapping;
498 	u8 bw_40 = 0;
499 	u8 short_gi = 0;
500 	__le32 *pdesc = (__le32 *)pdesc8;
501 
502 	if (mac->opmode == NL80211_IFTYPE_STATION) {
503 		bw_40 = mac->bw_40;
504 	} else if (mac->opmode == NL80211_IFTYPE_AP ||
505 		mac->opmode == NL80211_IFTYPE_ADHOC) {
506 		if (sta)
507 			bw_40 = sta->ht_cap.cap &
508 				IEEE80211_HT_CAP_SUP_WIDTH_20_40;
509 	}
510 	seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;
511 	rtl_get_tcb_desc(hw, info, sta, skb, ptcb_desc);
512 	/* reserve 8 byte for AMPDU early mode */
513 	if (rtlhal->earlymode_enable) {
514 		skb_push(skb, EM_HDR_LEN);
515 		memset(skb->data, 0, EM_HDR_LEN);
516 	}
517 	buf_len = skb->len;
518 	mapping = dma_map_single(&rtlpci->pdev->dev, skb->data, skb->len,
519 				 DMA_TO_DEVICE);
520 	if (dma_mapping_error(&rtlpci->pdev->dev, mapping)) {
521 		rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE,
522 			"DMA mapping error\n");
523 		return;
524 	}
525 	clear_pci_tx_desc_content(pdesc, sizeof(struct tx_desc_88e));
526 	if (ieee80211_is_nullfunc(fc) || ieee80211_is_ctl(fc)) {
527 		firstseg = true;
528 		lastseg = true;
529 	}
530 	if (firstseg) {
531 		if (rtlhal->earlymode_enable) {
532 			set_tx_desc_pkt_offset(pdesc, 1);
533 			set_tx_desc_offset(pdesc, USB_HWDESC_HEADER_LEN +
534 					   EM_HDR_LEN);
535 			if (ptcb_desc->empkt_num) {
536 				rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE,
537 					"Insert 8 byte.pTcb->EMPktNum:%d\n",
538 					ptcb_desc->empkt_num);
539 				rtl88ee_insert_emcontent(ptcb_desc,
540 							 (__le32 *)(skb->data));
541 			}
542 		} else {
543 			set_tx_desc_offset(pdesc, USB_HWDESC_HEADER_LEN);
544 		}
545 
546 		ptcb_desc->use_driver_rate = true;
547 		set_tx_desc_tx_rate(pdesc, ptcb_desc->hw_rate);
548 		if (ptcb_desc->hw_rate > DESC92C_RATEMCS0)
549 			short_gi = (ptcb_desc->use_shortgi) ? 1 : 0;
550 		else
551 			short_gi = (ptcb_desc->use_shortpreamble) ? 1 : 0;
552 
553 		set_tx_desc_data_shortgi(pdesc, short_gi);
554 
555 		if (info->flags & IEEE80211_TX_CTL_AMPDU) {
556 			set_tx_desc_agg_enable(pdesc, 1);
557 			set_tx_desc_max_agg_num(pdesc, 0x14);
558 		}
559 		set_tx_desc_seq(pdesc, seq_number);
560 		set_tx_desc_rts_enable(pdesc, ((ptcb_desc->rts_enable &&
561 						!ptcb_desc->cts_enable) ? 1 : 0));
562 		set_tx_desc_hw_rts_enable(pdesc, 0);
563 		set_tx_desc_cts2self(pdesc, ((ptcb_desc->cts_enable) ? 1 : 0));
564 		set_tx_desc_rts_stbc(pdesc, ((ptcb_desc->rts_stbc) ? 1 : 0));
565 
566 		set_tx_desc_rts_rate(pdesc, ptcb_desc->rts_rate);
567 		set_tx_desc_rts_bw(pdesc, 0);
568 		set_tx_desc_rts_sc(pdesc, ptcb_desc->rts_sc);
569 		set_tx_desc_rts_short(pdesc,
570 			((ptcb_desc->rts_rate <= DESC92C_RATE54M) ?
571 			(ptcb_desc->rts_use_shortpreamble ? 1 : 0) :
572 			(ptcb_desc->rts_use_shortgi ? 1 : 0)));
573 
574 		if (ptcb_desc->tx_enable_sw_calc_duration)
575 			set_tx_desc_nav_use_hdr(pdesc, 1);
576 
577 		if (bw_40) {
578 			if (ptcb_desc->packet_bw == HT_CHANNEL_WIDTH_20_40) {
579 				set_tx_desc_data_bw(pdesc, 1);
580 				set_tx_desc_tx_sub_carrier(pdesc, 3);
581 			} else {
582 				set_tx_desc_data_bw(pdesc, 0);
583 				set_tx_desc_tx_sub_carrier(pdesc,
584 							   mac->cur_40_prime_sc);
585 			}
586 		} else {
587 			set_tx_desc_data_bw(pdesc, 0);
588 			set_tx_desc_tx_sub_carrier(pdesc, 0);
589 		}
590 
591 		set_tx_desc_linip(pdesc, 0);
592 		set_tx_desc_pkt_size(pdesc, (u16)skb_len);
593 		if (sta) {
594 			u8 ampdu_density = sta->ht_cap.ampdu_density;
595 			set_tx_desc_ampdu_density(pdesc, ampdu_density);
596 		}
597 		if (info->control.hw_key) {
598 			struct ieee80211_key_conf *keyconf;
599 
600 			keyconf = info->control.hw_key;
601 			switch (keyconf->cipher) {
602 			case WLAN_CIPHER_SUITE_WEP40:
603 			case WLAN_CIPHER_SUITE_WEP104:
604 			case WLAN_CIPHER_SUITE_TKIP:
605 				set_tx_desc_sec_type(pdesc, 0x1);
606 				break;
607 			case WLAN_CIPHER_SUITE_CCMP:
608 				set_tx_desc_sec_type(pdesc, 0x3);
609 				break;
610 			default:
611 				set_tx_desc_sec_type(pdesc, 0x0);
612 				break;
613 
614 			}
615 		}
616 
617 		set_tx_desc_queue_sel(pdesc, fw_qsel);
618 		set_tx_desc_data_rate_fb_limit(pdesc, 0x1F);
619 		set_tx_desc_rts_rate_fb_limit(pdesc, 0xF);
620 		set_tx_desc_disable_fb(pdesc, ptcb_desc->disable_ratefallback ?
621 				       1 : 0);
622 		set_tx_desc_use_rate(pdesc, ptcb_desc->use_driver_rate ? 1 : 0);
623 
624 		/*set_tx_desc_pwr_status(pdesc, pwr_status);*/
625 		/* Set TxRate and RTSRate in TxDesc  */
626 		/* This prevent Tx initial rate of new-coming packets */
627 		/* from being overwritten by retried  packet rate.*/
628 		if (!ptcb_desc->use_driver_rate) {
629 			/*set_tx_desc_rts_rate(pdesc, 0x08); */
630 			/* set_tx_desc_tx_rate(pdesc, 0x0b); */
631 		}
632 		if (ieee80211_is_data_qos(fc)) {
633 			if (mac->rdg_en) {
634 				rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE,
635 					"Enable RDG function.\n");
636 				set_tx_desc_rdg_enable(pdesc, 1);
637 				set_tx_desc_htc(pdesc, 1);
638 			}
639 		}
640 	}
641 
642 	set_tx_desc_first_seg(pdesc, (firstseg ? 1 : 0));
643 	set_tx_desc_last_seg(pdesc, (lastseg ? 1 : 0));
644 	set_tx_desc_tx_buffer_size(pdesc, (u16)buf_len);
645 	set_tx_desc_tx_buffer_address(pdesc, mapping);
646 	if (rtlpriv->dm.useramask) {
647 		set_tx_desc_rate_id(pdesc, ptcb_desc->ratr_index);
648 		set_tx_desc_macid(pdesc, ptcb_desc->mac_id);
649 	} else {
650 		set_tx_desc_rate_id(pdesc, 0xC + ptcb_desc->ratr_index);
651 		set_tx_desc_macid(pdesc, ptcb_desc->ratr_index);
652 	}
653 	if (ieee80211_is_data_qos(fc))
654 		set_tx_desc_qos(pdesc, 1);
655 
656 	if (!ieee80211_is_data_qos(fc))
657 		set_tx_desc_hwseq_en(pdesc, 1);
658 	set_tx_desc_more_frag(pdesc, (lastseg ? 0 : 1));
659 	if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) ||
660 	    is_broadcast_ether_addr(ieee80211_get_DA(hdr))) {
661 		set_tx_desc_bmc(pdesc, 1);
662 	}
663 
664 	rtl88e_dm_set_tx_ant_by_tx_info(hw, pdesc8, ptcb_desc->mac_id);
665 	rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, "\n");
666 }
667 
668 void rtl88ee_tx_fill_cmddesc(struct ieee80211_hw *hw,
669 			     u8 *pdesc8, bool firstseg,
670 			     bool lastseg, struct sk_buff *skb)
671 {
672 	struct rtl_priv *rtlpriv = rtl_priv(hw);
673 	struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
674 	u8 fw_queue = QSLT_BEACON;
675 	__le32 *pdesc = (__le32 *)pdesc8;
676 
677 	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)(skb->data);
678 	__le16 fc = hdr->frame_control;
679 
680 	dma_addr_t mapping = dma_map_single(&rtlpci->pdev->dev, skb->data,
681 					    skb->len, DMA_TO_DEVICE);
682 
683 	if (dma_mapping_error(&rtlpci->pdev->dev, mapping)) {
684 		rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE,
685 			"DMA mapping error\n");
686 		return;
687 	}
688 	clear_pci_tx_desc_content(pdesc, TX_DESC_SIZE);
689 
690 	if (firstseg)
691 		set_tx_desc_offset(pdesc, USB_HWDESC_HEADER_LEN);
692 
693 	set_tx_desc_tx_rate(pdesc, DESC92C_RATE1M);
694 
695 	set_tx_desc_seq(pdesc, 0);
696 
697 	set_tx_desc_linip(pdesc, 0);
698 
699 	set_tx_desc_queue_sel(pdesc, fw_queue);
700 
701 	set_tx_desc_first_seg(pdesc, 1);
702 	set_tx_desc_last_seg(pdesc, 1);
703 
704 	set_tx_desc_tx_buffer_size(pdesc, (u16)(skb->len));
705 
706 	set_tx_desc_tx_buffer_address(pdesc, mapping);
707 
708 	set_tx_desc_rate_id(pdesc, 7);
709 	set_tx_desc_macid(pdesc, 0);
710 
711 	set_tx_desc_own(pdesc, 1);
712 
713 	set_tx_desc_pkt_size(pdesc, (u16)(skb->len));
714 
715 	set_tx_desc_first_seg(pdesc, 1);
716 	set_tx_desc_last_seg(pdesc, 1);
717 
718 	set_tx_desc_offset(pdesc, 0x20);
719 
720 	set_tx_desc_use_rate(pdesc, 1);
721 
722 	if (!ieee80211_is_data_qos(fc))
723 		set_tx_desc_hwseq_en(pdesc, 1);
724 
725 	RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD,
726 		      "H2C Tx Cmd Content\n",
727 		      pdesc, TX_DESC_SIZE);
728 }
729 
730 void rtl88ee_set_desc(struct ieee80211_hw *hw, u8 *pdesc8,
731 		      bool istx, u8 desc_name, u8 *val)
732 {
733 	__le32 *pdesc = (__le32 *)pdesc8;
734 
735 	if (istx) {
736 		switch (desc_name) {
737 		case HW_DESC_OWN:
738 			set_tx_desc_own(pdesc, 1);
739 			break;
740 		case HW_DESC_TX_NEXTDESC_ADDR:
741 			set_tx_desc_next_desc_address(pdesc, *(u32 *)val);
742 			break;
743 		default:
744 			WARN_ONCE(true, "rtl8188ee: ERR txdesc :%d not processed\n",
745 				  desc_name);
746 			break;
747 		}
748 	} else {
749 		switch (desc_name) {
750 		case HW_DESC_RXOWN:
751 			set_rx_desc_own(pdesc, 1);
752 			break;
753 		case HW_DESC_RXBUFF_ADDR:
754 			set_rx_desc_buff_addr(pdesc, *(u32 *)val);
755 			break;
756 		case HW_DESC_RXPKT_LEN:
757 			set_rx_desc_pkt_len(pdesc, *(u32 *)val);
758 			break;
759 		case HW_DESC_RXERO:
760 			set_rx_desc_eor(pdesc, 1);
761 			break;
762 		default:
763 			WARN_ONCE(true, "rtl8188ee: ERR rxdesc :%d not processed\n",
764 				  desc_name);
765 			break;
766 		}
767 	}
768 }
769 
770 u64 rtl88ee_get_desc(struct ieee80211_hw *hw,
771 		     u8 *pdesc8, bool istx, u8 desc_name)
772 {
773 	u32 ret = 0;
774 	__le32 *pdesc = (__le32 *)pdesc8;
775 
776 	if (istx) {
777 		switch (desc_name) {
778 		case HW_DESC_OWN:
779 			ret = get_tx_desc_own(pdesc);
780 			break;
781 		case HW_DESC_TXBUFF_ADDR:
782 			ret = get_tx_desc_tx_buffer_address(pdesc);
783 			break;
784 		default:
785 			WARN_ONCE(true, "rtl8188ee: ERR txdesc :%d not processed\n",
786 				  desc_name);
787 			break;
788 		}
789 	} else {
790 		switch (desc_name) {
791 		case HW_DESC_OWN:
792 			ret = get_rx_desc_own(pdesc);
793 			break;
794 		case HW_DESC_RXPKT_LEN:
795 			ret = get_rx_desc_pkt_len(pdesc);
796 			break;
797 		case HW_DESC_RXBUFF_ADDR:
798 			ret = get_rx_desc_buff_addr(pdesc);
799 			break;
800 		default:
801 			WARN_ONCE(true, "rtl8188ee: ERR rxdesc :%d not processed\n",
802 				  desc_name);
803 			break;
804 		}
805 	}
806 	return ret;
807 }
808 
809 bool rtl88ee_is_tx_desc_closed(struct ieee80211_hw *hw, u8 hw_queue, u16 index)
810 {
811 	struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
812 	struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[hw_queue];
813 	u8 *entry = (u8 *)(&ring->desc[ring->idx]);
814 	u8 own = (u8)rtl88ee_get_desc(hw, entry, true, HW_DESC_OWN);
815 
816 	/*beacon packet will only use the first
817 	 *descriptor defautly,and the own may not
818 	 *be cleared by the hardware
819 	 */
820 	if (own)
821 		return false;
822 	return true;
823 }
824 
825 void rtl88ee_tx_polling(struct ieee80211_hw *hw, u8 hw_queue)
826 {
827 	struct rtl_priv *rtlpriv = rtl_priv(hw);
828 	if (hw_queue == BEACON_QUEUE) {
829 		rtl_write_word(rtlpriv, REG_PCIE_CTRL_REG, BIT(4));
830 	} else {
831 		rtl_write_word(rtlpriv, REG_PCIE_CTRL_REG,
832 			       BIT(0) << (hw_queue));
833 	}
834 }
835