18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 28c2ecf20Sopenharmony_ci/* Copyright(c) 2009-2012 Realtek Corporation.*/ 38c2ecf20Sopenharmony_ci 48c2ecf20Sopenharmony_ci#include "../wifi.h" 58c2ecf20Sopenharmony_ci#include "../pci.h" 68c2ecf20Sopenharmony_ci#include "../base.h" 78c2ecf20Sopenharmony_ci#include "../stats.h" 88c2ecf20Sopenharmony_ci#include "reg.h" 98c2ecf20Sopenharmony_ci#include "def.h" 108c2ecf20Sopenharmony_ci#include "phy.h" 118c2ecf20Sopenharmony_ci#include "trx.h" 128c2ecf20Sopenharmony_ci#include "led.h" 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_cistatic u8 _rtl8723e_map_hwqueue_to_fwqueue(struct sk_buff *skb, u8 hw_queue) 158c2ecf20Sopenharmony_ci{ 168c2ecf20Sopenharmony_ci __le16 fc = rtl_get_fc(skb); 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci if (unlikely(ieee80211_is_beacon(fc))) 198c2ecf20Sopenharmony_ci return QSLT_BEACON; 208c2ecf20Sopenharmony_ci if (ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc)) 218c2ecf20Sopenharmony_ci return QSLT_MGNT; 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_ci return skb->priority; 248c2ecf20Sopenharmony_ci} 258c2ecf20Sopenharmony_ci 268c2ecf20Sopenharmony_cistatic void _rtl8723e_query_rxphystatus(struct ieee80211_hw *hw, 278c2ecf20Sopenharmony_ci struct rtl_stats *pstatus, u8 *pdesc, 288c2ecf20Sopenharmony_ci struct rx_fwinfo_8723e *p_drvinfo, 298c2ecf20Sopenharmony_ci bool bpacket_match_bssid, 308c2ecf20Sopenharmony_ci bool bpacket_toself, bool packet_beacon) 318c2ecf20Sopenharmony_ci{ 328c2ecf20Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 338c2ecf20Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv); 348c2ecf20Sopenharmony_ci struct phy_sts_cck_8723e_t *cck_buf; 358c2ecf20Sopenharmony_ci s8 rx_pwr_all = 0, rx_pwr[4]; 368c2ecf20Sopenharmony_ci u8 rf_rx_num = 0, evm, pwdb_all; 378c2ecf20Sopenharmony_ci u8 i, max_spatial_stream; 388c2ecf20Sopenharmony_ci u32 rssi, total_rssi = 0; 398c2ecf20Sopenharmony_ci bool is_cck = pstatus->is_cck; 408c2ecf20Sopenharmony_ci 418c2ecf20Sopenharmony_ci /* Record it for next packet processing */ 428c2ecf20Sopenharmony_ci pstatus->packet_matchbssid = bpacket_match_bssid; 438c2ecf20Sopenharmony_ci pstatus->packet_toself = bpacket_toself; 448c2ecf20Sopenharmony_ci pstatus->packet_beacon = packet_beacon; 458c2ecf20Sopenharmony_ci pstatus->rx_mimo_signalquality[0] = -1; 468c2ecf20Sopenharmony_ci pstatus->rx_mimo_signalquality[1] = -1; 478c2ecf20Sopenharmony_ci 488c2ecf20Sopenharmony_ci if (is_cck) { 498c2ecf20Sopenharmony_ci u8 report, cck_highpwr; 508c2ecf20Sopenharmony_ci 518c2ecf20Sopenharmony_ci /* CCK Driver info Structure is not the same as OFDM packet. */ 528c2ecf20Sopenharmony_ci cck_buf = (struct phy_sts_cck_8723e_t *)p_drvinfo; 538c2ecf20Sopenharmony_ci 548c2ecf20Sopenharmony_ci /* (1)Hardware does not provide RSSI for CCK */ 558c2ecf20Sopenharmony_ci /* (2)PWDB, Average PWDB cacluated by 568c2ecf20Sopenharmony_ci * hardware (for rate adaptive) 578c2ecf20Sopenharmony_ci */ 588c2ecf20Sopenharmony_ci if (ppsc->rfpwr_state == ERFON) 598c2ecf20Sopenharmony_ci cck_highpwr = (u8)rtl_get_bbreg(hw, 608c2ecf20Sopenharmony_ci RFPGA0_XA_HSSIPARAMETER2, 618c2ecf20Sopenharmony_ci BIT(9)); 628c2ecf20Sopenharmony_ci else 638c2ecf20Sopenharmony_ci cck_highpwr = false; 648c2ecf20Sopenharmony_ci 658c2ecf20Sopenharmony_ci if (!cck_highpwr) { 668c2ecf20Sopenharmony_ci u8 cck_agc_rpt = cck_buf->cck_agc_rpt; 678c2ecf20Sopenharmony_ci report = cck_buf->cck_agc_rpt & 0xc0; 688c2ecf20Sopenharmony_ci report = report >> 6; 698c2ecf20Sopenharmony_ci switch (report) { 708c2ecf20Sopenharmony_ci case 0x3: 718c2ecf20Sopenharmony_ci rx_pwr_all = -46 - (cck_agc_rpt & 0x3e); 728c2ecf20Sopenharmony_ci break; 738c2ecf20Sopenharmony_ci case 0x2: 748c2ecf20Sopenharmony_ci rx_pwr_all = -26 - (cck_agc_rpt & 0x3e); 758c2ecf20Sopenharmony_ci break; 768c2ecf20Sopenharmony_ci case 0x1: 778c2ecf20Sopenharmony_ci rx_pwr_all = -12 - (cck_agc_rpt & 0x3e); 788c2ecf20Sopenharmony_ci break; 798c2ecf20Sopenharmony_ci case 0x0: 808c2ecf20Sopenharmony_ci rx_pwr_all = 16 - (cck_agc_rpt & 0x3e); 818c2ecf20Sopenharmony_ci break; 828c2ecf20Sopenharmony_ci } 838c2ecf20Sopenharmony_ci } else { 848c2ecf20Sopenharmony_ci u8 cck_agc_rpt = cck_buf->cck_agc_rpt; 858c2ecf20Sopenharmony_ci report = p_drvinfo->cfosho[0] & 0x60; 868c2ecf20Sopenharmony_ci report = report >> 5; 878c2ecf20Sopenharmony_ci switch (report) { 888c2ecf20Sopenharmony_ci case 0x3: 898c2ecf20Sopenharmony_ci rx_pwr_all = -46 - ((cck_agc_rpt & 0x1f) << 1); 908c2ecf20Sopenharmony_ci break; 918c2ecf20Sopenharmony_ci case 0x2: 928c2ecf20Sopenharmony_ci rx_pwr_all = -26 - ((cck_agc_rpt & 0x1f) << 1); 938c2ecf20Sopenharmony_ci break; 948c2ecf20Sopenharmony_ci case 0x1: 958c2ecf20Sopenharmony_ci rx_pwr_all = -12 - ((cck_agc_rpt & 0x1f) << 1); 968c2ecf20Sopenharmony_ci break; 978c2ecf20Sopenharmony_ci case 0x0: 988c2ecf20Sopenharmony_ci rx_pwr_all = 16 - ((cck_agc_rpt & 0x1f) << 1); 998c2ecf20Sopenharmony_ci break; 1008c2ecf20Sopenharmony_ci } 1018c2ecf20Sopenharmony_ci } 1028c2ecf20Sopenharmony_ci 1038c2ecf20Sopenharmony_ci pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all); 1048c2ecf20Sopenharmony_ci /* CCK gain is smaller than OFDM/MCS gain, */ 1058c2ecf20Sopenharmony_ci /* so we add gain diff by experiences, 1068c2ecf20Sopenharmony_ci * the val is 6 1078c2ecf20Sopenharmony_ci */ 1088c2ecf20Sopenharmony_ci pwdb_all += 6; 1098c2ecf20Sopenharmony_ci if (pwdb_all > 100) 1108c2ecf20Sopenharmony_ci pwdb_all = 100; 1118c2ecf20Sopenharmony_ci /* modify the offset to make the same 1128c2ecf20Sopenharmony_ci * gain index with OFDM. 1138c2ecf20Sopenharmony_ci */ 1148c2ecf20Sopenharmony_ci if (pwdb_all > 34 && pwdb_all <= 42) 1158c2ecf20Sopenharmony_ci pwdb_all -= 2; 1168c2ecf20Sopenharmony_ci else if (pwdb_all > 26 && pwdb_all <= 34) 1178c2ecf20Sopenharmony_ci pwdb_all -= 6; 1188c2ecf20Sopenharmony_ci else if (pwdb_all > 14 && pwdb_all <= 26) 1198c2ecf20Sopenharmony_ci pwdb_all -= 8; 1208c2ecf20Sopenharmony_ci else if (pwdb_all > 4 && pwdb_all <= 14) 1218c2ecf20Sopenharmony_ci pwdb_all -= 4; 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_ci pstatus->rx_pwdb_all = pwdb_all; 1248c2ecf20Sopenharmony_ci pstatus->recvsignalpower = rx_pwr_all; 1258c2ecf20Sopenharmony_ci 1268c2ecf20Sopenharmony_ci /* (3) Get Signal Quality (EVM) */ 1278c2ecf20Sopenharmony_ci if (bpacket_match_bssid) { 1288c2ecf20Sopenharmony_ci u8 sq; 1298c2ecf20Sopenharmony_ci 1308c2ecf20Sopenharmony_ci if (pstatus->rx_pwdb_all > 40) 1318c2ecf20Sopenharmony_ci sq = 100; 1328c2ecf20Sopenharmony_ci else { 1338c2ecf20Sopenharmony_ci sq = cck_buf->sq_rpt; 1348c2ecf20Sopenharmony_ci if (sq > 64) 1358c2ecf20Sopenharmony_ci sq = 0; 1368c2ecf20Sopenharmony_ci else if (sq < 20) 1378c2ecf20Sopenharmony_ci sq = 100; 1388c2ecf20Sopenharmony_ci else 1398c2ecf20Sopenharmony_ci sq = ((64 - sq) * 100) / 44; 1408c2ecf20Sopenharmony_ci } 1418c2ecf20Sopenharmony_ci 1428c2ecf20Sopenharmony_ci pstatus->signalquality = sq; 1438c2ecf20Sopenharmony_ci pstatus->rx_mimo_signalquality[0] = sq; 1448c2ecf20Sopenharmony_ci pstatus->rx_mimo_signalquality[1] = -1; 1458c2ecf20Sopenharmony_ci } 1468c2ecf20Sopenharmony_ci } else { 1478c2ecf20Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[0] = 1488c2ecf20Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[1] = true; 1498c2ecf20Sopenharmony_ci 1508c2ecf20Sopenharmony_ci /* (1)Get RSSI for HT rate */ 1518c2ecf20Sopenharmony_ci for (i = RF90_PATH_A; i < RF6052_MAX_PATH; i++) { 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_ci /* we will judge RF RX path now. */ 1548c2ecf20Sopenharmony_ci if (rtlpriv->dm.rfpath_rxenable[i]) 1558c2ecf20Sopenharmony_ci rf_rx_num++; 1568c2ecf20Sopenharmony_ci 1578c2ecf20Sopenharmony_ci rx_pwr[i] = ((p_drvinfo->gain_trsw[i] & 1588c2ecf20Sopenharmony_ci 0x3f) * 2) - 110; 1598c2ecf20Sopenharmony_ci 1608c2ecf20Sopenharmony_ci /* Translate DBM to percentage. */ 1618c2ecf20Sopenharmony_ci rssi = rtl_query_rxpwrpercentage(rx_pwr[i]); 1628c2ecf20Sopenharmony_ci total_rssi += rssi; 1638c2ecf20Sopenharmony_ci 1648c2ecf20Sopenharmony_ci /* Get Rx snr value in DB */ 1658c2ecf20Sopenharmony_ci rtlpriv->stats.rx_snr_db[i] = 1668c2ecf20Sopenharmony_ci (long)(p_drvinfo->rxsnr[i] / 2); 1678c2ecf20Sopenharmony_ci 1688c2ecf20Sopenharmony_ci /* Record Signal Strength for next packet */ 1698c2ecf20Sopenharmony_ci if (bpacket_match_bssid) 1708c2ecf20Sopenharmony_ci pstatus->rx_mimo_signalstrength[i] = (u8)rssi; 1718c2ecf20Sopenharmony_ci } 1728c2ecf20Sopenharmony_ci 1738c2ecf20Sopenharmony_ci /* (2)PWDB, Average PWDB cacluated by 1748c2ecf20Sopenharmony_ci * hardware (for rate adaptive) 1758c2ecf20Sopenharmony_ci */ 1768c2ecf20Sopenharmony_ci rx_pwr_all = ((p_drvinfo->pwdb_all >> 1) & 0x7f) - 110; 1778c2ecf20Sopenharmony_ci 1788c2ecf20Sopenharmony_ci pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all); 1798c2ecf20Sopenharmony_ci pstatus->rx_pwdb_all = pwdb_all; 1808c2ecf20Sopenharmony_ci pstatus->rxpower = rx_pwr_all; 1818c2ecf20Sopenharmony_ci pstatus->recvsignalpower = rx_pwr_all; 1828c2ecf20Sopenharmony_ci 1838c2ecf20Sopenharmony_ci /* (3)EVM of HT rate */ 1848c2ecf20Sopenharmony_ci if (pstatus->is_ht && pstatus->rate >= DESC92C_RATEMCS8 && 1858c2ecf20Sopenharmony_ci pstatus->rate <= DESC92C_RATEMCS15) 1868c2ecf20Sopenharmony_ci max_spatial_stream = 2; 1878c2ecf20Sopenharmony_ci else 1888c2ecf20Sopenharmony_ci max_spatial_stream = 1; 1898c2ecf20Sopenharmony_ci 1908c2ecf20Sopenharmony_ci for (i = 0; i < max_spatial_stream; i++) { 1918c2ecf20Sopenharmony_ci evm = rtl_evm_db_to_percentage(p_drvinfo->rxevm[i]); 1928c2ecf20Sopenharmony_ci 1938c2ecf20Sopenharmony_ci if (bpacket_match_bssid) { 1948c2ecf20Sopenharmony_ci /* Fill value in RFD, Get the first 1958c2ecf20Sopenharmony_ci * spatial stream only 1968c2ecf20Sopenharmony_ci */ 1978c2ecf20Sopenharmony_ci if (i == 0) 1988c2ecf20Sopenharmony_ci pstatus->signalquality = 1998c2ecf20Sopenharmony_ci (u8)(evm & 0xff); 2008c2ecf20Sopenharmony_ci pstatus->rx_mimo_signalquality[i] = 2018c2ecf20Sopenharmony_ci (u8)(evm & 0xff); 2028c2ecf20Sopenharmony_ci } 2038c2ecf20Sopenharmony_ci } 2048c2ecf20Sopenharmony_ci } 2058c2ecf20Sopenharmony_ci 2068c2ecf20Sopenharmony_ci /* UI BSS List signal strength(in percentage), 2078c2ecf20Sopenharmony_ci * make it good looking, from 0~100. 2088c2ecf20Sopenharmony_ci */ 2098c2ecf20Sopenharmony_ci if (is_cck) 2108c2ecf20Sopenharmony_ci pstatus->signalstrength = (u8)(rtl_signal_scale_mapping(hw, 2118c2ecf20Sopenharmony_ci pwdb_all)); 2128c2ecf20Sopenharmony_ci else if (rf_rx_num != 0) 2138c2ecf20Sopenharmony_ci pstatus->signalstrength = (u8)(rtl_signal_scale_mapping(hw, 2148c2ecf20Sopenharmony_ci total_rssi /= rf_rx_num)); 2158c2ecf20Sopenharmony_ci} 2168c2ecf20Sopenharmony_ci 2178c2ecf20Sopenharmony_cistatic void translate_rx_signal_stuff(struct ieee80211_hw *hw, 2188c2ecf20Sopenharmony_ci struct sk_buff *skb, 2198c2ecf20Sopenharmony_ci struct rtl_stats *pstatus, u8 *pdesc, 2208c2ecf20Sopenharmony_ci struct rx_fwinfo_8723e *p_drvinfo) 2218c2ecf20Sopenharmony_ci{ 2228c2ecf20Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 2238c2ecf20Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 2248c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr; 2258c2ecf20Sopenharmony_ci u8 *tmp_buf; 2268c2ecf20Sopenharmony_ci u8 *praddr; 2278c2ecf20Sopenharmony_ci /*u8 *psaddr;*/ 2288c2ecf20Sopenharmony_ci u16 fc, type; 2298c2ecf20Sopenharmony_ci bool packet_matchbssid, packet_toself, packet_beacon; 2308c2ecf20Sopenharmony_ci 2318c2ecf20Sopenharmony_ci tmp_buf = skb->data + pstatus->rx_drvinfo_size + pstatus->rx_bufshift; 2328c2ecf20Sopenharmony_ci 2338c2ecf20Sopenharmony_ci hdr = (struct ieee80211_hdr *)tmp_buf; 2348c2ecf20Sopenharmony_ci fc = le16_to_cpu(hdr->frame_control); 2358c2ecf20Sopenharmony_ci type = WLAN_FC_GET_TYPE(hdr->frame_control); 2368c2ecf20Sopenharmony_ci praddr = hdr->addr1; 2378c2ecf20Sopenharmony_ci 2388c2ecf20Sopenharmony_ci packet_matchbssid = ((IEEE80211_FTYPE_CTL != type) && 2398c2ecf20Sopenharmony_ci (ether_addr_equal(mac->bssid, (fc & IEEE80211_FCTL_TODS) ? 2408c2ecf20Sopenharmony_ci hdr->addr1 : (fc & IEEE80211_FCTL_FROMDS) ? 2418c2ecf20Sopenharmony_ci hdr->addr2 : hdr->addr3)) && 2428c2ecf20Sopenharmony_ci (!pstatus->hwerror) && 2438c2ecf20Sopenharmony_ci (!pstatus->crc) && (!pstatus->icv)); 2448c2ecf20Sopenharmony_ci 2458c2ecf20Sopenharmony_ci packet_toself = packet_matchbssid && 2468c2ecf20Sopenharmony_ci (ether_addr_equal(praddr, rtlefuse->dev_addr)); 2478c2ecf20Sopenharmony_ci 2488c2ecf20Sopenharmony_ci if (ieee80211_is_beacon(hdr->frame_control)) 2498c2ecf20Sopenharmony_ci packet_beacon = true; 2508c2ecf20Sopenharmony_ci else 2518c2ecf20Sopenharmony_ci packet_beacon = false; 2528c2ecf20Sopenharmony_ci 2538c2ecf20Sopenharmony_ci _rtl8723e_query_rxphystatus(hw, pstatus, pdesc, p_drvinfo, 2548c2ecf20Sopenharmony_ci packet_matchbssid, packet_toself, 2558c2ecf20Sopenharmony_ci packet_beacon); 2568c2ecf20Sopenharmony_ci 2578c2ecf20Sopenharmony_ci rtl_process_phyinfo(hw, tmp_buf, pstatus); 2588c2ecf20Sopenharmony_ci} 2598c2ecf20Sopenharmony_ci 2608c2ecf20Sopenharmony_cibool rtl8723e_rx_query_desc(struct ieee80211_hw *hw, 2618c2ecf20Sopenharmony_ci struct rtl_stats *status, 2628c2ecf20Sopenharmony_ci struct ieee80211_rx_status *rx_status, 2638c2ecf20Sopenharmony_ci u8 *pdesc8, struct sk_buff *skb) 2648c2ecf20Sopenharmony_ci{ 2658c2ecf20Sopenharmony_ci struct rx_fwinfo_8723e *p_drvinfo; 2668c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr; 2678c2ecf20Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 2688c2ecf20Sopenharmony_ci u32 phystatus = get_rx_desc_physt(pdesc); 2698c2ecf20Sopenharmony_ci 2708c2ecf20Sopenharmony_ci status->length = (u16)get_rx_desc_pkt_len(pdesc); 2718c2ecf20Sopenharmony_ci status->rx_drvinfo_size = (u8)get_rx_desc_drv_info_size(pdesc) * 2728c2ecf20Sopenharmony_ci RX_DRV_INFO_SIZE_UNIT; 2738c2ecf20Sopenharmony_ci status->rx_bufshift = (u8)(get_rx_desc_shift(pdesc) & 0x03); 2748c2ecf20Sopenharmony_ci status->icv = (u16)get_rx_desc_icv(pdesc); 2758c2ecf20Sopenharmony_ci status->crc = (u16)get_rx_desc_crc32(pdesc); 2768c2ecf20Sopenharmony_ci status->hwerror = (status->crc | status->icv); 2778c2ecf20Sopenharmony_ci status->decrypted = !get_rx_desc_swdec(pdesc); 2788c2ecf20Sopenharmony_ci status->rate = (u8)get_rx_desc_rxmcs(pdesc); 2798c2ecf20Sopenharmony_ci status->shortpreamble = (u16)get_rx_desc_splcp(pdesc); 2808c2ecf20Sopenharmony_ci status->isampdu = (bool)(get_rx_desc_paggr(pdesc) == 1); 2818c2ecf20Sopenharmony_ci status->isfirst_ampdu = (bool)((get_rx_desc_paggr(pdesc) == 1) && 2828c2ecf20Sopenharmony_ci (get_rx_desc_faggr(pdesc) == 1)); 2838c2ecf20Sopenharmony_ci status->timestamp_low = get_rx_desc_tsfl(pdesc); 2848c2ecf20Sopenharmony_ci status->rx_is40mhzpacket = (bool)get_rx_desc_bw(pdesc); 2858c2ecf20Sopenharmony_ci status->is_ht = (bool)get_rx_desc_rxht(pdesc); 2868c2ecf20Sopenharmony_ci 2878c2ecf20Sopenharmony_ci status->is_cck = RX_HAL_IS_CCK_RATE(status->rate); 2888c2ecf20Sopenharmony_ci 2898c2ecf20Sopenharmony_ci rx_status->freq = hw->conf.chandef.chan->center_freq; 2908c2ecf20Sopenharmony_ci rx_status->band = hw->conf.chandef.chan->band; 2918c2ecf20Sopenharmony_ci 2928c2ecf20Sopenharmony_ci hdr = (struct ieee80211_hdr *)(skb->data + status->rx_drvinfo_size 2938c2ecf20Sopenharmony_ci + status->rx_bufshift); 2948c2ecf20Sopenharmony_ci 2958c2ecf20Sopenharmony_ci if (status->crc) 2968c2ecf20Sopenharmony_ci rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; 2978c2ecf20Sopenharmony_ci 2988c2ecf20Sopenharmony_ci if (status->rx_is40mhzpacket) 2998c2ecf20Sopenharmony_ci rx_status->bw = RATE_INFO_BW_40; 3008c2ecf20Sopenharmony_ci 3018c2ecf20Sopenharmony_ci if (status->is_ht) 3028c2ecf20Sopenharmony_ci rx_status->encoding = RX_ENC_HT; 3038c2ecf20Sopenharmony_ci 3048c2ecf20Sopenharmony_ci rx_status->flag |= RX_FLAG_MACTIME_START; 3058c2ecf20Sopenharmony_ci 3068c2ecf20Sopenharmony_ci /* hw will set status->decrypted true, if it finds the 3078c2ecf20Sopenharmony_ci * frame is open data frame or mgmt frame. 3088c2ecf20Sopenharmony_ci * So hw will not decryption robust managment frame 3098c2ecf20Sopenharmony_ci * for IEEE80211w but still set status->decrypted 3108c2ecf20Sopenharmony_ci * true, so here we should set it back to undecrypted 3118c2ecf20Sopenharmony_ci * for IEEE80211w frame, and mac80211 sw will help 3128c2ecf20Sopenharmony_ci * to decrypt it 3138c2ecf20Sopenharmony_ci */ 3148c2ecf20Sopenharmony_ci if (status->decrypted) { 3158c2ecf20Sopenharmony_ci if ((!_ieee80211_is_robust_mgmt_frame(hdr)) && 3168c2ecf20Sopenharmony_ci (ieee80211_has_protected(hdr->frame_control))) 3178c2ecf20Sopenharmony_ci rx_status->flag |= RX_FLAG_DECRYPTED; 3188c2ecf20Sopenharmony_ci else 3198c2ecf20Sopenharmony_ci rx_status->flag &= ~RX_FLAG_DECRYPTED; 3208c2ecf20Sopenharmony_ci } 3218c2ecf20Sopenharmony_ci 3228c2ecf20Sopenharmony_ci /* rate_idx: index of data rate into band's 3238c2ecf20Sopenharmony_ci * supported rates or MCS index if HT rates 3248c2ecf20Sopenharmony_ci * are use (RX_FLAG_HT) 3258c2ecf20Sopenharmony_ci * Notice: this is diff with windows define 3268c2ecf20Sopenharmony_ci */ 3278c2ecf20Sopenharmony_ci rx_status->rate_idx = rtlwifi_rate_mapping(hw, status->is_ht, 3288c2ecf20Sopenharmony_ci false, status->rate); 3298c2ecf20Sopenharmony_ci 3308c2ecf20Sopenharmony_ci rx_status->mactime = status->timestamp_low; 3318c2ecf20Sopenharmony_ci if (phystatus == true) { 3328c2ecf20Sopenharmony_ci p_drvinfo = (struct rx_fwinfo_8723e *)(skb->data + 3338c2ecf20Sopenharmony_ci status->rx_bufshift); 3348c2ecf20Sopenharmony_ci 3358c2ecf20Sopenharmony_ci translate_rx_signal_stuff(hw, skb, status, pdesc8, p_drvinfo); 3368c2ecf20Sopenharmony_ci } 3378c2ecf20Sopenharmony_ci rx_status->signal = status->recvsignalpower + 10; 3388c2ecf20Sopenharmony_ci return true; 3398c2ecf20Sopenharmony_ci} 3408c2ecf20Sopenharmony_ci 3418c2ecf20Sopenharmony_civoid rtl8723e_tx_fill_desc(struct ieee80211_hw *hw, 3428c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr, u8 *pdesc_tx, 3438c2ecf20Sopenharmony_ci u8 *txbd, struct ieee80211_tx_info *info, 3448c2ecf20Sopenharmony_ci struct ieee80211_sta *sta, 3458c2ecf20Sopenharmony_ci struct sk_buff *skb, 3468c2ecf20Sopenharmony_ci u8 hw_queue, struct rtl_tcb_desc *ptcb_desc) 3478c2ecf20Sopenharmony_ci{ 3488c2ecf20Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 3498c2ecf20Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 3508c2ecf20Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 3518c2ecf20Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw)); 3528c2ecf20Sopenharmony_ci bool b_defaultadapter = true; 3538c2ecf20Sopenharmony_ci /* bool b_trigger_ac = false; */ 3548c2ecf20Sopenharmony_ci u8 *pdesc8 = (u8 *)pdesc_tx; 3558c2ecf20Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 3568c2ecf20Sopenharmony_ci u16 seq_number; 3578c2ecf20Sopenharmony_ci __le16 fc = hdr->frame_control; 3588c2ecf20Sopenharmony_ci u8 fw_qsel = _rtl8723e_map_hwqueue_to_fwqueue(skb, hw_queue); 3598c2ecf20Sopenharmony_ci bool firstseg = ((hdr->seq_ctrl & 3608c2ecf20Sopenharmony_ci cpu_to_le16(IEEE80211_SCTL_FRAG)) == 0); 3618c2ecf20Sopenharmony_ci 3628c2ecf20Sopenharmony_ci bool lastseg = ((hdr->frame_control & 3638c2ecf20Sopenharmony_ci cpu_to_le16(IEEE80211_FCTL_MOREFRAGS)) == 0); 3648c2ecf20Sopenharmony_ci 3658c2ecf20Sopenharmony_ci dma_addr_t mapping = dma_map_single(&rtlpci->pdev->dev, skb->data, 3668c2ecf20Sopenharmony_ci skb->len, DMA_TO_DEVICE); 3678c2ecf20Sopenharmony_ci u8 bw_40 = 0; 3688c2ecf20Sopenharmony_ci 3698c2ecf20Sopenharmony_ci if (dma_mapping_error(&rtlpci->pdev->dev, mapping)) { 3708c2ecf20Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, 3718c2ecf20Sopenharmony_ci "DMA mapping error\n"); 3728c2ecf20Sopenharmony_ci return; 3738c2ecf20Sopenharmony_ci } 3748c2ecf20Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_STATION) { 3758c2ecf20Sopenharmony_ci bw_40 = mac->bw_40; 3768c2ecf20Sopenharmony_ci } else if (mac->opmode == NL80211_IFTYPE_AP || 3778c2ecf20Sopenharmony_ci mac->opmode == NL80211_IFTYPE_ADHOC) { 3788c2ecf20Sopenharmony_ci if (sta) 3798c2ecf20Sopenharmony_ci bw_40 = sta->ht_cap.cap & 3808c2ecf20Sopenharmony_ci IEEE80211_HT_CAP_SUP_WIDTH_20_40; 3818c2ecf20Sopenharmony_ci } 3828c2ecf20Sopenharmony_ci 3838c2ecf20Sopenharmony_ci seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4; 3848c2ecf20Sopenharmony_ci 3858c2ecf20Sopenharmony_ci rtl_get_tcb_desc(hw, info, sta, skb, ptcb_desc); 3868c2ecf20Sopenharmony_ci 3878c2ecf20Sopenharmony_ci clear_pci_tx_desc_content(pdesc, sizeof(struct tx_desc_8723e)); 3888c2ecf20Sopenharmony_ci 3898c2ecf20Sopenharmony_ci if (ieee80211_is_nullfunc(fc) || ieee80211_is_ctl(fc)) { 3908c2ecf20Sopenharmony_ci firstseg = true; 3918c2ecf20Sopenharmony_ci lastseg = true; 3928c2ecf20Sopenharmony_ci } 3938c2ecf20Sopenharmony_ci 3948c2ecf20Sopenharmony_ci if (firstseg) { 3958c2ecf20Sopenharmony_ci set_tx_desc_offset(pdesc, USB_HWDESC_HEADER_LEN); 3968c2ecf20Sopenharmony_ci 3978c2ecf20Sopenharmony_ci set_tx_desc_tx_rate(pdesc, ptcb_desc->hw_rate); 3988c2ecf20Sopenharmony_ci 3998c2ecf20Sopenharmony_ci if (ptcb_desc->use_shortgi || ptcb_desc->use_shortpreamble) 4008c2ecf20Sopenharmony_ci set_tx_desc_data_shortgi(pdesc, 1); 4018c2ecf20Sopenharmony_ci 4028c2ecf20Sopenharmony_ci if (info->flags & IEEE80211_TX_CTL_AMPDU) { 4038c2ecf20Sopenharmony_ci set_tx_desc_agg_break(pdesc, 1); 4048c2ecf20Sopenharmony_ci set_tx_desc_max_agg_num(pdesc, 0x14); 4058c2ecf20Sopenharmony_ci } 4068c2ecf20Sopenharmony_ci set_tx_desc_seq(pdesc, seq_number); 4078c2ecf20Sopenharmony_ci 4088c2ecf20Sopenharmony_ci set_tx_desc_rts_enable(pdesc, 4098c2ecf20Sopenharmony_ci ((ptcb_desc->rts_enable && 4108c2ecf20Sopenharmony_ci !ptcb_desc->cts_enable) ? 1 : 0)); 4118c2ecf20Sopenharmony_ci set_tx_desc_hw_rts_enable(pdesc, 4128c2ecf20Sopenharmony_ci ((ptcb_desc->rts_enable || 4138c2ecf20Sopenharmony_ci ptcb_desc->cts_enable) ? 1 : 0)); 4148c2ecf20Sopenharmony_ci set_tx_desc_cts2self(pdesc, 4158c2ecf20Sopenharmony_ci ((ptcb_desc->cts_enable) ? 1 : 0)); 4168c2ecf20Sopenharmony_ci set_tx_desc_rts_stbc(pdesc, 4178c2ecf20Sopenharmony_ci ((ptcb_desc->rts_stbc) ? 1 : 0)); 4188c2ecf20Sopenharmony_ci 4198c2ecf20Sopenharmony_ci set_tx_desc_rts_rate(pdesc, ptcb_desc->rts_rate); 4208c2ecf20Sopenharmony_ci set_tx_desc_rts_bw(pdesc, 0); 4218c2ecf20Sopenharmony_ci set_tx_desc_rts_sc(pdesc, ptcb_desc->rts_sc); 4228c2ecf20Sopenharmony_ci set_tx_desc_rts_short(pdesc, 4238c2ecf20Sopenharmony_ci ((ptcb_desc->rts_rate <= DESC92C_RATE54M) ? 4248c2ecf20Sopenharmony_ci (ptcb_desc->rts_use_shortpreamble ? 1 : 0) 4258c2ecf20Sopenharmony_ci : (ptcb_desc->rts_use_shortgi ? 1 : 0))); 4268c2ecf20Sopenharmony_ci 4278c2ecf20Sopenharmony_ci if (bw_40) { 4288c2ecf20Sopenharmony_ci if (ptcb_desc->packet_bw == HT_CHANNEL_WIDTH_20_40) { 4298c2ecf20Sopenharmony_ci set_tx_desc_data_bw(pdesc, 1); 4308c2ecf20Sopenharmony_ci set_tx_desc_tx_sub_carrier(pdesc, 3); 4318c2ecf20Sopenharmony_ci } else { 4328c2ecf20Sopenharmony_ci set_tx_desc_data_bw(pdesc, 0); 4338c2ecf20Sopenharmony_ci set_tx_desc_tx_sub_carrier(pdesc, 4348c2ecf20Sopenharmony_ci mac->cur_40_prime_sc); 4358c2ecf20Sopenharmony_ci } 4368c2ecf20Sopenharmony_ci } else { 4378c2ecf20Sopenharmony_ci set_tx_desc_data_bw(pdesc, 0); 4388c2ecf20Sopenharmony_ci set_tx_desc_tx_sub_carrier(pdesc, 0); 4398c2ecf20Sopenharmony_ci } 4408c2ecf20Sopenharmony_ci 4418c2ecf20Sopenharmony_ci set_tx_desc_linip(pdesc, 0); 4428c2ecf20Sopenharmony_ci set_tx_desc_pkt_size(pdesc, (u16)skb->len); 4438c2ecf20Sopenharmony_ci 4448c2ecf20Sopenharmony_ci if (sta) { 4458c2ecf20Sopenharmony_ci u8 ampdu_density = sta->ht_cap.ampdu_density; 4468c2ecf20Sopenharmony_ci set_tx_desc_ampdu_density(pdesc, ampdu_density); 4478c2ecf20Sopenharmony_ci } 4488c2ecf20Sopenharmony_ci 4498c2ecf20Sopenharmony_ci if (info->control.hw_key) { 4508c2ecf20Sopenharmony_ci struct ieee80211_key_conf *keyconf = 4518c2ecf20Sopenharmony_ci info->control.hw_key; 4528c2ecf20Sopenharmony_ci 4538c2ecf20Sopenharmony_ci switch (keyconf->cipher) { 4548c2ecf20Sopenharmony_ci case WLAN_CIPHER_SUITE_WEP40: 4558c2ecf20Sopenharmony_ci case WLAN_CIPHER_SUITE_WEP104: 4568c2ecf20Sopenharmony_ci case WLAN_CIPHER_SUITE_TKIP: 4578c2ecf20Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x1); 4588c2ecf20Sopenharmony_ci break; 4598c2ecf20Sopenharmony_ci case WLAN_CIPHER_SUITE_CCMP: 4608c2ecf20Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x3); 4618c2ecf20Sopenharmony_ci break; 4628c2ecf20Sopenharmony_ci default: 4638c2ecf20Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x0); 4648c2ecf20Sopenharmony_ci break; 4658c2ecf20Sopenharmony_ci 4668c2ecf20Sopenharmony_ci } 4678c2ecf20Sopenharmony_ci } 4688c2ecf20Sopenharmony_ci 4698c2ecf20Sopenharmony_ci set_tx_desc_pkt_id(pdesc, 0); 4708c2ecf20Sopenharmony_ci set_tx_desc_queue_sel(pdesc, fw_qsel); 4718c2ecf20Sopenharmony_ci 4728c2ecf20Sopenharmony_ci set_tx_desc_data_rate_fb_limit(pdesc, 0x1F); 4738c2ecf20Sopenharmony_ci set_tx_desc_rts_rate_fb_limit(pdesc, 0xF); 4748c2ecf20Sopenharmony_ci set_tx_desc_disable_fb(pdesc, 0); 4758c2ecf20Sopenharmony_ci set_tx_desc_use_rate(pdesc, ptcb_desc->use_driver_rate ? 1 : 0); 4768c2ecf20Sopenharmony_ci 4778c2ecf20Sopenharmony_ci if (ieee80211_is_data_qos(fc)) { 4788c2ecf20Sopenharmony_ci if (mac->rdg_en) { 4798c2ecf20Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, 4808c2ecf20Sopenharmony_ci "Enable RDG function.\n"); 4818c2ecf20Sopenharmony_ci set_tx_desc_rdg_enable(pdesc, 1); 4828c2ecf20Sopenharmony_ci set_tx_desc_htc(pdesc, 1); 4838c2ecf20Sopenharmony_ci } 4848c2ecf20Sopenharmony_ci } 4858c2ecf20Sopenharmony_ci } 4868c2ecf20Sopenharmony_ci 4878c2ecf20Sopenharmony_ci set_tx_desc_first_seg(pdesc, (firstseg ? 1 : 0)); 4888c2ecf20Sopenharmony_ci set_tx_desc_last_seg(pdesc, (lastseg ? 1 : 0)); 4898c2ecf20Sopenharmony_ci 4908c2ecf20Sopenharmony_ci set_tx_desc_tx_buffer_size(pdesc, (u16)skb->len); 4918c2ecf20Sopenharmony_ci 4928c2ecf20Sopenharmony_ci set_tx_desc_tx_buffer_address(pdesc, mapping); 4938c2ecf20Sopenharmony_ci 4948c2ecf20Sopenharmony_ci if (rtlpriv->dm.useramask) { 4958c2ecf20Sopenharmony_ci set_tx_desc_rate_id(pdesc, ptcb_desc->ratr_index); 4968c2ecf20Sopenharmony_ci set_tx_desc_macid(pdesc, ptcb_desc->mac_id); 4978c2ecf20Sopenharmony_ci } else { 4988c2ecf20Sopenharmony_ci set_tx_desc_rate_id(pdesc, 0xC + ptcb_desc->ratr_index); 4998c2ecf20Sopenharmony_ci set_tx_desc_macid(pdesc, ptcb_desc->ratr_index); 5008c2ecf20Sopenharmony_ci } 5018c2ecf20Sopenharmony_ci 5028c2ecf20Sopenharmony_ci if ((!ieee80211_is_data_qos(fc)) && ppsc->fwctrl_lps) { 5038c2ecf20Sopenharmony_ci set_tx_desc_hwseq_en_8723(pdesc, 1); 5048c2ecf20Sopenharmony_ci /* set_tx_desc_hwseq_en(pdesc, 1); */ 5058c2ecf20Sopenharmony_ci /* set_tx_desc_pkt_id(pdesc, 8); */ 5068c2ecf20Sopenharmony_ci 5078c2ecf20Sopenharmony_ci if (!b_defaultadapter) 5088c2ecf20Sopenharmony_ci set_tx_desc_hwseq_sel_8723(pdesc, 1); 5098c2ecf20Sopenharmony_ci /* set_tx_desc_qos(pdesc, 1); */ 5108c2ecf20Sopenharmony_ci } 5118c2ecf20Sopenharmony_ci 5128c2ecf20Sopenharmony_ci set_tx_desc_more_frag(pdesc, (lastseg ? 0 : 1)); 5138c2ecf20Sopenharmony_ci 5148c2ecf20Sopenharmony_ci if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) || 5158c2ecf20Sopenharmony_ci is_broadcast_ether_addr(ieee80211_get_DA(hdr))) { 5168c2ecf20Sopenharmony_ci set_tx_desc_bmc(pdesc, 1); 5178c2ecf20Sopenharmony_ci } 5188c2ecf20Sopenharmony_ci 5198c2ecf20Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, "\n"); 5208c2ecf20Sopenharmony_ci} 5218c2ecf20Sopenharmony_ci 5228c2ecf20Sopenharmony_civoid rtl8723e_tx_fill_cmddesc(struct ieee80211_hw *hw, 5238c2ecf20Sopenharmony_ci u8 *pdesc8, bool firstseg, 5248c2ecf20Sopenharmony_ci bool lastseg, struct sk_buff *skb) 5258c2ecf20Sopenharmony_ci{ 5268c2ecf20Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 5278c2ecf20Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 5288c2ecf20Sopenharmony_ci u8 fw_queue = QSLT_BEACON; 5298c2ecf20Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 5308c2ecf20Sopenharmony_ci 5318c2ecf20Sopenharmony_ci dma_addr_t mapping = dma_map_single(&rtlpci->pdev->dev, skb->data, 5328c2ecf20Sopenharmony_ci skb->len, DMA_TO_DEVICE); 5338c2ecf20Sopenharmony_ci 5348c2ecf20Sopenharmony_ci struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)(skb->data); 5358c2ecf20Sopenharmony_ci __le16 fc = hdr->frame_control; 5368c2ecf20Sopenharmony_ci 5378c2ecf20Sopenharmony_ci if (dma_mapping_error(&rtlpci->pdev->dev, mapping)) { 5388c2ecf20Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, 5398c2ecf20Sopenharmony_ci "DMA mapping error\n"); 5408c2ecf20Sopenharmony_ci return; 5418c2ecf20Sopenharmony_ci } 5428c2ecf20Sopenharmony_ci clear_pci_tx_desc_content(pdesc, TX_DESC_SIZE); 5438c2ecf20Sopenharmony_ci 5448c2ecf20Sopenharmony_ci if (firstseg) 5458c2ecf20Sopenharmony_ci set_tx_desc_offset(pdesc, USB_HWDESC_HEADER_LEN); 5468c2ecf20Sopenharmony_ci 5478c2ecf20Sopenharmony_ci set_tx_desc_tx_rate(pdesc, DESC92C_RATE1M); 5488c2ecf20Sopenharmony_ci 5498c2ecf20Sopenharmony_ci set_tx_desc_seq(pdesc, 0); 5508c2ecf20Sopenharmony_ci 5518c2ecf20Sopenharmony_ci set_tx_desc_linip(pdesc, 0); 5528c2ecf20Sopenharmony_ci 5538c2ecf20Sopenharmony_ci set_tx_desc_queue_sel(pdesc, fw_queue); 5548c2ecf20Sopenharmony_ci 5558c2ecf20Sopenharmony_ci set_tx_desc_first_seg(pdesc, 1); 5568c2ecf20Sopenharmony_ci set_tx_desc_last_seg(pdesc, 1); 5578c2ecf20Sopenharmony_ci 5588c2ecf20Sopenharmony_ci set_tx_desc_tx_buffer_size(pdesc, (u16)(skb->len)); 5598c2ecf20Sopenharmony_ci 5608c2ecf20Sopenharmony_ci set_tx_desc_tx_buffer_address(pdesc, mapping); 5618c2ecf20Sopenharmony_ci 5628c2ecf20Sopenharmony_ci set_tx_desc_rate_id(pdesc, 7); 5638c2ecf20Sopenharmony_ci set_tx_desc_macid(pdesc, 0); 5648c2ecf20Sopenharmony_ci 5658c2ecf20Sopenharmony_ci set_tx_desc_own(pdesc, 1); 5668c2ecf20Sopenharmony_ci 5678c2ecf20Sopenharmony_ci set_tx_desc_pkt_size(pdesc, (u16)(skb->len)); 5688c2ecf20Sopenharmony_ci 5698c2ecf20Sopenharmony_ci set_tx_desc_first_seg(pdesc, 1); 5708c2ecf20Sopenharmony_ci set_tx_desc_last_seg(pdesc, 1); 5718c2ecf20Sopenharmony_ci 5728c2ecf20Sopenharmony_ci set_tx_desc_offset(pdesc, 0x20); 5738c2ecf20Sopenharmony_ci 5748c2ecf20Sopenharmony_ci set_tx_desc_use_rate(pdesc, 1); 5758c2ecf20Sopenharmony_ci 5768c2ecf20Sopenharmony_ci if (!ieee80211_is_data_qos(fc)) { 5778c2ecf20Sopenharmony_ci set_tx_desc_hwseq_en_8723(pdesc, 1); 5788c2ecf20Sopenharmony_ci /* set_tx_desc_hwseq_en(pdesc, 1); */ 5798c2ecf20Sopenharmony_ci /* set_tx_desc_pkt_id(pdesc, 8); */ 5808c2ecf20Sopenharmony_ci } 5818c2ecf20Sopenharmony_ci 5828c2ecf20Sopenharmony_ci RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD, 5838c2ecf20Sopenharmony_ci "H2C Tx Cmd Content\n", 5848c2ecf20Sopenharmony_ci pdesc, TX_DESC_SIZE); 5858c2ecf20Sopenharmony_ci} 5868c2ecf20Sopenharmony_ci 5878c2ecf20Sopenharmony_civoid rtl8723e_set_desc(struct ieee80211_hw *hw, u8 *pdesc8, 5888c2ecf20Sopenharmony_ci bool istx, u8 desc_name, u8 *val) 5898c2ecf20Sopenharmony_ci{ 5908c2ecf20Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 5918c2ecf20Sopenharmony_ci 5928c2ecf20Sopenharmony_ci if (istx) { 5938c2ecf20Sopenharmony_ci switch (desc_name) { 5948c2ecf20Sopenharmony_ci case HW_DESC_OWN: 5958c2ecf20Sopenharmony_ci set_tx_desc_own(pdesc, 1); 5968c2ecf20Sopenharmony_ci break; 5978c2ecf20Sopenharmony_ci case HW_DESC_TX_NEXTDESC_ADDR: 5988c2ecf20Sopenharmony_ci set_tx_desc_next_desc_address(pdesc, *(u32 *)val); 5998c2ecf20Sopenharmony_ci break; 6008c2ecf20Sopenharmony_ci default: 6018c2ecf20Sopenharmony_ci WARN_ONCE(true, "rtl8723ae: ERR txdesc :%d not processed\n", 6028c2ecf20Sopenharmony_ci desc_name); 6038c2ecf20Sopenharmony_ci break; 6048c2ecf20Sopenharmony_ci } 6058c2ecf20Sopenharmony_ci } else { 6068c2ecf20Sopenharmony_ci switch (desc_name) { 6078c2ecf20Sopenharmony_ci case HW_DESC_RXOWN: 6088c2ecf20Sopenharmony_ci set_rx_desc_own(pdesc, 1); 6098c2ecf20Sopenharmony_ci break; 6108c2ecf20Sopenharmony_ci case HW_DESC_RXBUFF_ADDR: 6118c2ecf20Sopenharmony_ci set_rx_desc_buff_addr(pdesc, *(u32 *)val); 6128c2ecf20Sopenharmony_ci break; 6138c2ecf20Sopenharmony_ci case HW_DESC_RXPKT_LEN: 6148c2ecf20Sopenharmony_ci set_rx_desc_pkt_len(pdesc, *(u32 *)val); 6158c2ecf20Sopenharmony_ci break; 6168c2ecf20Sopenharmony_ci case HW_DESC_RXERO: 6178c2ecf20Sopenharmony_ci set_rx_desc_eor(pdesc, 1); 6188c2ecf20Sopenharmony_ci break; 6198c2ecf20Sopenharmony_ci default: 6208c2ecf20Sopenharmony_ci WARN_ONCE(true, "rtl8723ae: ERR rxdesc :%d not processed\n", 6218c2ecf20Sopenharmony_ci desc_name); 6228c2ecf20Sopenharmony_ci break; 6238c2ecf20Sopenharmony_ci } 6248c2ecf20Sopenharmony_ci } 6258c2ecf20Sopenharmony_ci} 6268c2ecf20Sopenharmony_ci 6278c2ecf20Sopenharmony_ciu64 rtl8723e_get_desc(struct ieee80211_hw *hw, 6288c2ecf20Sopenharmony_ci u8 *pdesc8, bool istx, u8 desc_name) 6298c2ecf20Sopenharmony_ci{ 6308c2ecf20Sopenharmony_ci u32 ret = 0; 6318c2ecf20Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 6328c2ecf20Sopenharmony_ci 6338c2ecf20Sopenharmony_ci if (istx) { 6348c2ecf20Sopenharmony_ci switch (desc_name) { 6358c2ecf20Sopenharmony_ci case HW_DESC_OWN: 6368c2ecf20Sopenharmony_ci ret = get_tx_desc_own(pdesc); 6378c2ecf20Sopenharmony_ci break; 6388c2ecf20Sopenharmony_ci case HW_DESC_TXBUFF_ADDR: 6398c2ecf20Sopenharmony_ci ret = get_tx_desc_tx_buffer_address(pdesc); 6408c2ecf20Sopenharmony_ci break; 6418c2ecf20Sopenharmony_ci default: 6428c2ecf20Sopenharmony_ci WARN_ONCE(true, "rtl8723ae: ERR txdesc :%d not processed\n", 6438c2ecf20Sopenharmony_ci desc_name); 6448c2ecf20Sopenharmony_ci break; 6458c2ecf20Sopenharmony_ci } 6468c2ecf20Sopenharmony_ci } else { 6478c2ecf20Sopenharmony_ci switch (desc_name) { 6488c2ecf20Sopenharmony_ci case HW_DESC_OWN: 6498c2ecf20Sopenharmony_ci ret = get_rx_desc_own(pdesc); 6508c2ecf20Sopenharmony_ci break; 6518c2ecf20Sopenharmony_ci case HW_DESC_RXPKT_LEN: 6528c2ecf20Sopenharmony_ci ret = get_rx_desc_pkt_len(pdesc); 6538c2ecf20Sopenharmony_ci break; 6548c2ecf20Sopenharmony_ci case HW_DESC_RXBUFF_ADDR: 6558c2ecf20Sopenharmony_ci ret = get_rx_desc_buff_addr(pdesc); 6568c2ecf20Sopenharmony_ci break; 6578c2ecf20Sopenharmony_ci default: 6588c2ecf20Sopenharmony_ci WARN_ONCE(true, "rtl8723ae: ERR rxdesc :%d not processed\n", 6598c2ecf20Sopenharmony_ci desc_name); 6608c2ecf20Sopenharmony_ci break; 6618c2ecf20Sopenharmony_ci } 6628c2ecf20Sopenharmony_ci } 6638c2ecf20Sopenharmony_ci return ret; 6648c2ecf20Sopenharmony_ci} 6658c2ecf20Sopenharmony_ci 6668c2ecf20Sopenharmony_cibool rtl8723e_is_tx_desc_closed(struct ieee80211_hw *hw, 6678c2ecf20Sopenharmony_ci u8 hw_queue, u16 index) 6688c2ecf20Sopenharmony_ci{ 6698c2ecf20Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 6708c2ecf20Sopenharmony_ci struct rtl8192_tx_ring *ring = &rtlpci->tx_ring[hw_queue]; 6718c2ecf20Sopenharmony_ci u8 *entry = (u8 *)(&ring->desc[ring->idx]); 6728c2ecf20Sopenharmony_ci u8 own = (u8)rtl8723e_get_desc(hw, entry, true, HW_DESC_OWN); 6738c2ecf20Sopenharmony_ci 6748c2ecf20Sopenharmony_ci /** 6758c2ecf20Sopenharmony_ci *beacon packet will only use the first 6768c2ecf20Sopenharmony_ci *descriptor defautly,and the own may not 6778c2ecf20Sopenharmony_ci *be cleared by the hardware 6788c2ecf20Sopenharmony_ci */ 6798c2ecf20Sopenharmony_ci if (own) 6808c2ecf20Sopenharmony_ci return false; 6818c2ecf20Sopenharmony_ci return true; 6828c2ecf20Sopenharmony_ci} 6838c2ecf20Sopenharmony_ci 6848c2ecf20Sopenharmony_civoid rtl8723e_tx_polling(struct ieee80211_hw *hw, u8 hw_queue) 6858c2ecf20Sopenharmony_ci{ 6868c2ecf20Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 6878c2ecf20Sopenharmony_ci if (hw_queue == BEACON_QUEUE) { 6888c2ecf20Sopenharmony_ci rtl_write_word(rtlpriv, REG_PCIE_CTRL_REG, BIT(4)); 6898c2ecf20Sopenharmony_ci } else { 6908c2ecf20Sopenharmony_ci rtl_write_word(rtlpriv, REG_PCIE_CTRL_REG, 6918c2ecf20Sopenharmony_ci BIT(0) << (hw_queue)); 6928c2ecf20Sopenharmony_ci } 6938c2ecf20Sopenharmony_ci} 694