162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* Copyright(c) 2009-2012 Realtek Corporation.*/ 362306a36Sopenharmony_ci 462306a36Sopenharmony_ci#include "../wifi.h" 562306a36Sopenharmony_ci#include "../pci.h" 662306a36Sopenharmony_ci#include "../base.h" 762306a36Sopenharmony_ci#include "../stats.h" 862306a36Sopenharmony_ci#include "reg.h" 962306a36Sopenharmony_ci#include "def.h" 1062306a36Sopenharmony_ci#include "phy.h" 1162306a36Sopenharmony_ci#include "fw.h" 1262306a36Sopenharmony_ci#include "trx.h" 1362306a36Sopenharmony_ci#include "led.h" 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_cistatic u8 _rtl92se_map_hwqueue_to_fwqueue(struct sk_buff *skb, u8 skb_queue) 1662306a36Sopenharmony_ci{ 1762306a36Sopenharmony_ci __le16 fc = rtl_get_fc(skb); 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci if (unlikely(ieee80211_is_beacon(fc))) 2062306a36Sopenharmony_ci return QSLT_BEACON; 2162306a36Sopenharmony_ci if (ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc)) 2262306a36Sopenharmony_ci return QSLT_MGNT; 2362306a36Sopenharmony_ci if (ieee80211_is_nullfunc(fc)) 2462306a36Sopenharmony_ci return QSLT_HIGH; 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_ci /* Kernel commit 1bf4bbb4024dcdab changed EAPOL packets to use 2762306a36Sopenharmony_ci * queue V0 at priority 7; however, the RTL8192SE appears to have 2862306a36Sopenharmony_ci * that queue at priority 6 2962306a36Sopenharmony_ci */ 3062306a36Sopenharmony_ci if (skb->priority == 7) 3162306a36Sopenharmony_ci return QSLT_VO; 3262306a36Sopenharmony_ci return skb->priority; 3362306a36Sopenharmony_ci} 3462306a36Sopenharmony_ci 3562306a36Sopenharmony_cistatic void _rtl92se_query_rxphystatus(struct ieee80211_hw *hw, 3662306a36Sopenharmony_ci struct rtl_stats *pstats, __le32 *pdesc, 3762306a36Sopenharmony_ci struct rx_fwinfo *p_drvinfo, 3862306a36Sopenharmony_ci bool packet_match_bssid, 3962306a36Sopenharmony_ci bool packet_toself, 4062306a36Sopenharmony_ci bool packet_beacon) 4162306a36Sopenharmony_ci{ 4262306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 4362306a36Sopenharmony_ci struct phy_sts_cck_8192s_t *cck_buf; 4462306a36Sopenharmony_ci struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv); 4562306a36Sopenharmony_ci s8 rx_pwr_all = 0, rx_pwr[4]; 4662306a36Sopenharmony_ci u8 rf_rx_num = 0, evm, pwdb_all; 4762306a36Sopenharmony_ci u8 i, max_spatial_stream; 4862306a36Sopenharmony_ci u32 rssi, total_rssi = 0; 4962306a36Sopenharmony_ci bool is_cck = pstats->is_cck; 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_ci pstats->packet_matchbssid = packet_match_bssid; 5262306a36Sopenharmony_ci pstats->packet_toself = packet_toself; 5362306a36Sopenharmony_ci pstats->packet_beacon = packet_beacon; 5462306a36Sopenharmony_ci pstats->rx_mimo_sig_qual[0] = -1; 5562306a36Sopenharmony_ci pstats->rx_mimo_sig_qual[1] = -1; 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci if (is_cck) { 5862306a36Sopenharmony_ci u8 report, cck_highpwr; 5962306a36Sopenharmony_ci cck_buf = (struct phy_sts_cck_8192s_t *)p_drvinfo; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci if (ppsc->rfpwr_state == ERFON) 6262306a36Sopenharmony_ci cck_highpwr = (u8) rtl_get_bbreg(hw, 6362306a36Sopenharmony_ci RFPGA0_XA_HSSIPARAMETER2, 6462306a36Sopenharmony_ci 0x200); 6562306a36Sopenharmony_ci else 6662306a36Sopenharmony_ci cck_highpwr = false; 6762306a36Sopenharmony_ci 6862306a36Sopenharmony_ci if (!cck_highpwr) { 6962306a36Sopenharmony_ci u8 cck_agc_rpt = cck_buf->cck_agc_rpt; 7062306a36Sopenharmony_ci report = cck_buf->cck_agc_rpt & 0xc0; 7162306a36Sopenharmony_ci report = report >> 6; 7262306a36Sopenharmony_ci switch (report) { 7362306a36Sopenharmony_ci case 0x3: 7462306a36Sopenharmony_ci rx_pwr_all = -40 - (cck_agc_rpt & 0x3e); 7562306a36Sopenharmony_ci break; 7662306a36Sopenharmony_ci case 0x2: 7762306a36Sopenharmony_ci rx_pwr_all = -20 - (cck_agc_rpt & 0x3e); 7862306a36Sopenharmony_ci break; 7962306a36Sopenharmony_ci case 0x1: 8062306a36Sopenharmony_ci rx_pwr_all = -2 - (cck_agc_rpt & 0x3e); 8162306a36Sopenharmony_ci break; 8262306a36Sopenharmony_ci case 0x0: 8362306a36Sopenharmony_ci rx_pwr_all = 14 - (cck_agc_rpt & 0x3e); 8462306a36Sopenharmony_ci break; 8562306a36Sopenharmony_ci } 8662306a36Sopenharmony_ci } else { 8762306a36Sopenharmony_ci u8 cck_agc_rpt = cck_buf->cck_agc_rpt; 8862306a36Sopenharmony_ci report = p_drvinfo->cfosho[0] & 0x60; 8962306a36Sopenharmony_ci report = report >> 5; 9062306a36Sopenharmony_ci switch (report) { 9162306a36Sopenharmony_ci case 0x3: 9262306a36Sopenharmony_ci rx_pwr_all = -40 - ((cck_agc_rpt & 0x1f) << 1); 9362306a36Sopenharmony_ci break; 9462306a36Sopenharmony_ci case 0x2: 9562306a36Sopenharmony_ci rx_pwr_all = -20 - ((cck_agc_rpt & 0x1f) << 1); 9662306a36Sopenharmony_ci break; 9762306a36Sopenharmony_ci case 0x1: 9862306a36Sopenharmony_ci rx_pwr_all = -2 - ((cck_agc_rpt & 0x1f) << 1); 9962306a36Sopenharmony_ci break; 10062306a36Sopenharmony_ci case 0x0: 10162306a36Sopenharmony_ci rx_pwr_all = 14 - ((cck_agc_rpt & 0x1f) << 1); 10262306a36Sopenharmony_ci break; 10362306a36Sopenharmony_ci } 10462306a36Sopenharmony_ci } 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all); 10762306a36Sopenharmony_ci 10862306a36Sopenharmony_ci /* CCK gain is smaller than OFDM/MCS gain, */ 10962306a36Sopenharmony_ci /* so we add gain diff by experiences, the val is 6 */ 11062306a36Sopenharmony_ci pwdb_all += 6; 11162306a36Sopenharmony_ci if (pwdb_all > 100) 11262306a36Sopenharmony_ci pwdb_all = 100; 11362306a36Sopenharmony_ci /* modify the offset to make the same gain index with OFDM. */ 11462306a36Sopenharmony_ci if (pwdb_all > 34 && pwdb_all <= 42) 11562306a36Sopenharmony_ci pwdb_all -= 2; 11662306a36Sopenharmony_ci else if (pwdb_all > 26 && pwdb_all <= 34) 11762306a36Sopenharmony_ci pwdb_all -= 6; 11862306a36Sopenharmony_ci else if (pwdb_all > 14 && pwdb_all <= 26) 11962306a36Sopenharmony_ci pwdb_all -= 8; 12062306a36Sopenharmony_ci else if (pwdb_all > 4 && pwdb_all <= 14) 12162306a36Sopenharmony_ci pwdb_all -= 4; 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci pstats->rx_pwdb_all = pwdb_all; 12462306a36Sopenharmony_ci pstats->recvsignalpower = rx_pwr_all; 12562306a36Sopenharmony_ci 12662306a36Sopenharmony_ci if (packet_match_bssid) { 12762306a36Sopenharmony_ci u8 sq; 12862306a36Sopenharmony_ci if (pstats->rx_pwdb_all > 40) { 12962306a36Sopenharmony_ci sq = 100; 13062306a36Sopenharmony_ci } else { 13162306a36Sopenharmony_ci sq = cck_buf->sq_rpt; 13262306a36Sopenharmony_ci if (sq > 64) 13362306a36Sopenharmony_ci sq = 0; 13462306a36Sopenharmony_ci else if (sq < 20) 13562306a36Sopenharmony_ci sq = 100; 13662306a36Sopenharmony_ci else 13762306a36Sopenharmony_ci sq = ((64 - sq) * 100) / 44; 13862306a36Sopenharmony_ci } 13962306a36Sopenharmony_ci 14062306a36Sopenharmony_ci pstats->signalquality = sq; 14162306a36Sopenharmony_ci pstats->rx_mimo_sig_qual[0] = sq; 14262306a36Sopenharmony_ci pstats->rx_mimo_sig_qual[1] = -1; 14362306a36Sopenharmony_ci } 14462306a36Sopenharmony_ci } else { 14562306a36Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[0] = 14662306a36Sopenharmony_ci rtlpriv->dm.rfpath_rxenable[1] = true; 14762306a36Sopenharmony_ci for (i = RF90_PATH_A; i < RF6052_MAX_PATH; i++) { 14862306a36Sopenharmony_ci if (rtlpriv->dm.rfpath_rxenable[i]) 14962306a36Sopenharmony_ci rf_rx_num++; 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci rx_pwr[i] = ((p_drvinfo->gain_trsw[i] & 15262306a36Sopenharmony_ci 0x3f) * 2) - 110; 15362306a36Sopenharmony_ci rssi = rtl_query_rxpwrpercentage(rx_pwr[i]); 15462306a36Sopenharmony_ci total_rssi += rssi; 15562306a36Sopenharmony_ci rtlpriv->stats.rx_snr_db[i] = 15662306a36Sopenharmony_ci (long)(p_drvinfo->rxsnr[i] / 2); 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci if (packet_match_bssid) 15962306a36Sopenharmony_ci pstats->rx_mimo_signalstrength[i] = (u8) rssi; 16062306a36Sopenharmony_ci } 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_ci rx_pwr_all = ((p_drvinfo->pwdb_all >> 1) & 0x7f) - 110; 16362306a36Sopenharmony_ci pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all); 16462306a36Sopenharmony_ci pstats->rx_pwdb_all = pwdb_all; 16562306a36Sopenharmony_ci pstats->rxpower = rx_pwr_all; 16662306a36Sopenharmony_ci pstats->recvsignalpower = rx_pwr_all; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci if (pstats->is_ht && pstats->rate >= DESC_RATEMCS8 && 16962306a36Sopenharmony_ci pstats->rate <= DESC_RATEMCS15) 17062306a36Sopenharmony_ci max_spatial_stream = 2; 17162306a36Sopenharmony_ci else 17262306a36Sopenharmony_ci max_spatial_stream = 1; 17362306a36Sopenharmony_ci 17462306a36Sopenharmony_ci for (i = 0; i < max_spatial_stream; i++) { 17562306a36Sopenharmony_ci evm = rtl_evm_db_to_percentage(p_drvinfo->rxevm[i]); 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci if (packet_match_bssid) { 17862306a36Sopenharmony_ci if (i == 0) 17962306a36Sopenharmony_ci pstats->signalquality = (u8)(evm & 18062306a36Sopenharmony_ci 0xff); 18162306a36Sopenharmony_ci pstats->rx_mimo_sig_qual[i] = (u8) (evm & 0xff); 18262306a36Sopenharmony_ci } 18362306a36Sopenharmony_ci } 18462306a36Sopenharmony_ci } 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci if (is_cck) 18762306a36Sopenharmony_ci pstats->signalstrength = (u8)(rtl_signal_scale_mapping(hw, 18862306a36Sopenharmony_ci pwdb_all)); 18962306a36Sopenharmony_ci else if (rf_rx_num != 0) 19062306a36Sopenharmony_ci pstats->signalstrength = (u8) (rtl_signal_scale_mapping(hw, 19162306a36Sopenharmony_ci total_rssi /= rf_rx_num)); 19262306a36Sopenharmony_ci} 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_cistatic void _rtl92se_translate_rx_signal_stuff(struct ieee80211_hw *hw, 19562306a36Sopenharmony_ci struct sk_buff *skb, struct rtl_stats *pstats, 19662306a36Sopenharmony_ci __le32 *pdesc, struct rx_fwinfo *p_drvinfo) 19762306a36Sopenharmony_ci{ 19862306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 19962306a36Sopenharmony_ci struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw)); 20062306a36Sopenharmony_ci struct ieee80211_hdr *hdr; 20162306a36Sopenharmony_ci u8 *tmp_buf; 20262306a36Sopenharmony_ci u8 *praddr; 20362306a36Sopenharmony_ci __le16 fc; 20462306a36Sopenharmony_ci u16 type, cfc; 20562306a36Sopenharmony_ci bool packet_matchbssid, packet_toself, packet_beacon = false; 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_ci tmp_buf = skb->data + pstats->rx_drvinfo_size + pstats->rx_bufshift; 20862306a36Sopenharmony_ci 20962306a36Sopenharmony_ci hdr = (struct ieee80211_hdr *)tmp_buf; 21062306a36Sopenharmony_ci fc = hdr->frame_control; 21162306a36Sopenharmony_ci cfc = le16_to_cpu(fc); 21262306a36Sopenharmony_ci type = WLAN_FC_GET_TYPE(fc); 21362306a36Sopenharmony_ci praddr = hdr->addr1; 21462306a36Sopenharmony_ci 21562306a36Sopenharmony_ci packet_matchbssid = ((IEEE80211_FTYPE_CTL != type) && 21662306a36Sopenharmony_ci ether_addr_equal(mac->bssid, 21762306a36Sopenharmony_ci (cfc & IEEE80211_FCTL_TODS) ? hdr->addr1 : 21862306a36Sopenharmony_ci (cfc & IEEE80211_FCTL_FROMDS) ? hdr->addr2 : 21962306a36Sopenharmony_ci hdr->addr3) && 22062306a36Sopenharmony_ci (!pstats->hwerror) && (!pstats->crc) && (!pstats->icv)); 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci packet_toself = packet_matchbssid && 22362306a36Sopenharmony_ci ether_addr_equal(praddr, rtlefuse->dev_addr); 22462306a36Sopenharmony_ci 22562306a36Sopenharmony_ci if (ieee80211_is_beacon(fc)) 22662306a36Sopenharmony_ci packet_beacon = true; 22762306a36Sopenharmony_ci 22862306a36Sopenharmony_ci _rtl92se_query_rxphystatus(hw, pstats, pdesc, p_drvinfo, 22962306a36Sopenharmony_ci packet_matchbssid, packet_toself, packet_beacon); 23062306a36Sopenharmony_ci rtl_process_phyinfo(hw, tmp_buf, pstats); 23162306a36Sopenharmony_ci} 23262306a36Sopenharmony_ci 23362306a36Sopenharmony_cibool rtl92se_rx_query_desc(struct ieee80211_hw *hw, struct rtl_stats *stats, 23462306a36Sopenharmony_ci struct ieee80211_rx_status *rx_status, u8 *pdesc8, 23562306a36Sopenharmony_ci struct sk_buff *skb) 23662306a36Sopenharmony_ci{ 23762306a36Sopenharmony_ci struct rx_fwinfo *p_drvinfo; 23862306a36Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 23962306a36Sopenharmony_ci u32 phystatus = (u32)get_rx_status_desc_phy_status(pdesc); 24062306a36Sopenharmony_ci struct ieee80211_hdr *hdr; 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci stats->length = (u16)get_rx_status_desc_pkt_len(pdesc); 24362306a36Sopenharmony_ci stats->rx_drvinfo_size = (u8)get_rx_status_desc_drvinfo_size(pdesc) * 8; 24462306a36Sopenharmony_ci stats->rx_bufshift = (u8)(get_rx_status_desc_shift(pdesc) & 0x03); 24562306a36Sopenharmony_ci stats->icv = (u16)get_rx_status_desc_icv(pdesc); 24662306a36Sopenharmony_ci stats->crc = (u16)get_rx_status_desc_crc32(pdesc); 24762306a36Sopenharmony_ci stats->hwerror = (u16)(stats->crc | stats->icv); 24862306a36Sopenharmony_ci stats->decrypted = !get_rx_status_desc_swdec(pdesc); 24962306a36Sopenharmony_ci 25062306a36Sopenharmony_ci stats->rate = (u8)get_rx_status_desc_rx_mcs(pdesc); 25162306a36Sopenharmony_ci stats->shortpreamble = (u16)get_rx_status_desc_splcp(pdesc); 25262306a36Sopenharmony_ci stats->isampdu = (bool)(get_rx_status_desc_paggr(pdesc) == 1); 25362306a36Sopenharmony_ci stats->isfirst_ampdu = (bool)((get_rx_status_desc_paggr(pdesc) == 1) && 25462306a36Sopenharmony_ci (get_rx_status_desc_faggr(pdesc) == 1)); 25562306a36Sopenharmony_ci stats->timestamp_low = get_rx_status_desc_tsfl(pdesc); 25662306a36Sopenharmony_ci stats->rx_is40mhzpacket = (bool)get_rx_status_desc_bw(pdesc); 25762306a36Sopenharmony_ci stats->is_ht = (bool)get_rx_status_desc_rx_ht(pdesc); 25862306a36Sopenharmony_ci stats->is_cck = SE_RX_HAL_IS_CCK_RATE(pdesc); 25962306a36Sopenharmony_ci 26062306a36Sopenharmony_ci if (stats->hwerror) 26162306a36Sopenharmony_ci return false; 26262306a36Sopenharmony_ci 26362306a36Sopenharmony_ci rx_status->freq = hw->conf.chandef.chan->center_freq; 26462306a36Sopenharmony_ci rx_status->band = hw->conf.chandef.chan->band; 26562306a36Sopenharmony_ci 26662306a36Sopenharmony_ci if (stats->crc) 26762306a36Sopenharmony_ci rx_status->flag |= RX_FLAG_FAILED_FCS_CRC; 26862306a36Sopenharmony_ci 26962306a36Sopenharmony_ci if (stats->rx_is40mhzpacket) 27062306a36Sopenharmony_ci rx_status->bw = RATE_INFO_BW_40; 27162306a36Sopenharmony_ci 27262306a36Sopenharmony_ci if (stats->is_ht) 27362306a36Sopenharmony_ci rx_status->encoding = RX_ENC_HT; 27462306a36Sopenharmony_ci 27562306a36Sopenharmony_ci rx_status->flag |= RX_FLAG_MACTIME_START; 27662306a36Sopenharmony_ci 27762306a36Sopenharmony_ci /* hw will set stats->decrypted true, if it finds the 27862306a36Sopenharmony_ci * frame is open data frame or mgmt frame, 27962306a36Sopenharmony_ci * hw will not decrypt robust managment frame 28062306a36Sopenharmony_ci * for IEEE80211w but still set stats->decrypted 28162306a36Sopenharmony_ci * true, so here we should set it back to undecrypted 28262306a36Sopenharmony_ci * for IEEE80211w frame, and mac80211 sw will help 28362306a36Sopenharmony_ci * to decrypt it */ 28462306a36Sopenharmony_ci if (stats->decrypted) { 28562306a36Sopenharmony_ci hdr = (struct ieee80211_hdr *)(skb->data + 28662306a36Sopenharmony_ci stats->rx_drvinfo_size + stats->rx_bufshift); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci if ((_ieee80211_is_robust_mgmt_frame(hdr)) && 28962306a36Sopenharmony_ci (ieee80211_has_protected(hdr->frame_control))) 29062306a36Sopenharmony_ci rx_status->flag &= ~RX_FLAG_DECRYPTED; 29162306a36Sopenharmony_ci else 29262306a36Sopenharmony_ci rx_status->flag |= RX_FLAG_DECRYPTED; 29362306a36Sopenharmony_ci } 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci rx_status->rate_idx = rtlwifi_rate_mapping(hw, stats->is_ht, 29662306a36Sopenharmony_ci false, stats->rate); 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ci rx_status->mactime = stats->timestamp_low; 29962306a36Sopenharmony_ci if (phystatus) { 30062306a36Sopenharmony_ci p_drvinfo = (struct rx_fwinfo *)(skb->data + 30162306a36Sopenharmony_ci stats->rx_bufshift); 30262306a36Sopenharmony_ci _rtl92se_translate_rx_signal_stuff(hw, skb, stats, pdesc, 30362306a36Sopenharmony_ci p_drvinfo); 30462306a36Sopenharmony_ci } 30562306a36Sopenharmony_ci 30662306a36Sopenharmony_ci /*rx_status->qual = stats->signal; */ 30762306a36Sopenharmony_ci rx_status->signal = stats->recvsignalpower + 10; 30862306a36Sopenharmony_ci 30962306a36Sopenharmony_ci return true; 31062306a36Sopenharmony_ci} 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_civoid rtl92se_tx_fill_desc(struct ieee80211_hw *hw, 31362306a36Sopenharmony_ci struct ieee80211_hdr *hdr, u8 *pdesc8, 31462306a36Sopenharmony_ci u8 *pbd_desc_tx, struct ieee80211_tx_info *info, 31562306a36Sopenharmony_ci struct ieee80211_sta *sta, 31662306a36Sopenharmony_ci struct sk_buff *skb, 31762306a36Sopenharmony_ci u8 hw_queue, struct rtl_tcb_desc *ptcb_desc) 31862306a36Sopenharmony_ci{ 31962306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 32062306a36Sopenharmony_ci struct rtl_mac *mac = rtl_mac(rtl_priv(hw)); 32162306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 32262306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 32362306a36Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 32462306a36Sopenharmony_ci u16 seq_number; 32562306a36Sopenharmony_ci __le16 fc = hdr->frame_control; 32662306a36Sopenharmony_ci u8 reserved_macid = 0; 32762306a36Sopenharmony_ci u8 fw_qsel = _rtl92se_map_hwqueue_to_fwqueue(skb, hw_queue); 32862306a36Sopenharmony_ci bool firstseg = (!(hdr->seq_ctrl & cpu_to_le16(IEEE80211_SCTL_FRAG))); 32962306a36Sopenharmony_ci bool lastseg = (!(hdr->frame_control & 33062306a36Sopenharmony_ci cpu_to_le16(IEEE80211_FCTL_MOREFRAGS))); 33162306a36Sopenharmony_ci dma_addr_t mapping = dma_map_single(&rtlpci->pdev->dev, skb->data, 33262306a36Sopenharmony_ci skb->len, DMA_TO_DEVICE); 33362306a36Sopenharmony_ci u8 bw_40 = 0; 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci if (dma_mapping_error(&rtlpci->pdev->dev, mapping)) { 33662306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, 33762306a36Sopenharmony_ci "DMA mapping error\n"); 33862306a36Sopenharmony_ci return; 33962306a36Sopenharmony_ci } 34062306a36Sopenharmony_ci if (mac->opmode == NL80211_IFTYPE_STATION) { 34162306a36Sopenharmony_ci bw_40 = mac->bw_40; 34262306a36Sopenharmony_ci } else if (mac->opmode == NL80211_IFTYPE_AP || 34362306a36Sopenharmony_ci mac->opmode == NL80211_IFTYPE_ADHOC) { 34462306a36Sopenharmony_ci if (sta) 34562306a36Sopenharmony_ci bw_40 = sta->deflink.bandwidth >= IEEE80211_STA_RX_BW_40; 34662306a36Sopenharmony_ci } 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4; 34962306a36Sopenharmony_ci 35062306a36Sopenharmony_ci rtl_get_tcb_desc(hw, info, sta, skb, ptcb_desc); 35162306a36Sopenharmony_ci 35262306a36Sopenharmony_ci CLEAR_PCI_TX_DESC_CONTENT(pdesc, TX_DESC_SIZE_RTL8192S); 35362306a36Sopenharmony_ci 35462306a36Sopenharmony_ci if (ieee80211_is_nullfunc(fc) || ieee80211_is_ctl(fc)) { 35562306a36Sopenharmony_ci firstseg = true; 35662306a36Sopenharmony_ci lastseg = true; 35762306a36Sopenharmony_ci } 35862306a36Sopenharmony_ci 35962306a36Sopenharmony_ci if (firstseg) { 36062306a36Sopenharmony_ci if (rtlpriv->dm.useramask) { 36162306a36Sopenharmony_ci /* set txdesc macId */ 36262306a36Sopenharmony_ci if (ptcb_desc->mac_id < 32) { 36362306a36Sopenharmony_ci set_tx_desc_macid(pdesc, ptcb_desc->mac_id); 36462306a36Sopenharmony_ci reserved_macid |= ptcb_desc->mac_id; 36562306a36Sopenharmony_ci } 36662306a36Sopenharmony_ci } 36762306a36Sopenharmony_ci set_tx_desc_rsvd_macid(pdesc, reserved_macid); 36862306a36Sopenharmony_ci 36962306a36Sopenharmony_ci set_tx_desc_txht(pdesc, ((ptcb_desc->hw_rate >= 37062306a36Sopenharmony_ci DESC_RATEMCS0) ? 1 : 0)); 37162306a36Sopenharmony_ci 37262306a36Sopenharmony_ci if (rtlhal->version == VERSION_8192S_ACUT) { 37362306a36Sopenharmony_ci if (ptcb_desc->hw_rate == DESC_RATE1M || 37462306a36Sopenharmony_ci ptcb_desc->hw_rate == DESC_RATE2M || 37562306a36Sopenharmony_ci ptcb_desc->hw_rate == DESC_RATE5_5M || 37662306a36Sopenharmony_ci ptcb_desc->hw_rate == DESC_RATE11M) { 37762306a36Sopenharmony_ci ptcb_desc->hw_rate = DESC_RATE12M; 37862306a36Sopenharmony_ci } 37962306a36Sopenharmony_ci } 38062306a36Sopenharmony_ci 38162306a36Sopenharmony_ci set_tx_desc_tx_rate(pdesc, ptcb_desc->hw_rate); 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci if (ptcb_desc->use_shortgi || ptcb_desc->use_shortpreamble) 38462306a36Sopenharmony_ci set_tx_desc_tx_short(pdesc, 0); 38562306a36Sopenharmony_ci 38662306a36Sopenharmony_ci /* Aggregation related */ 38762306a36Sopenharmony_ci if (info->flags & IEEE80211_TX_CTL_AMPDU) 38862306a36Sopenharmony_ci set_tx_desc_agg_enable(pdesc, 1); 38962306a36Sopenharmony_ci 39062306a36Sopenharmony_ci /* For AMPDU, we must insert SSN into TX_DESC */ 39162306a36Sopenharmony_ci set_tx_desc_seq(pdesc, seq_number); 39262306a36Sopenharmony_ci 39362306a36Sopenharmony_ci /* Protection mode related */ 39462306a36Sopenharmony_ci /* For 92S, if RTS/CTS are set, HW will execute RTS. */ 39562306a36Sopenharmony_ci /* We choose only one protection mode to execute */ 39662306a36Sopenharmony_ci set_tx_desc_rts_enable(pdesc, ((ptcb_desc->rts_enable && 39762306a36Sopenharmony_ci !ptcb_desc->cts_enable) ? 39862306a36Sopenharmony_ci 1 : 0)); 39962306a36Sopenharmony_ci set_tx_desc_cts_enable(pdesc, ((ptcb_desc->cts_enable) ? 40062306a36Sopenharmony_ci 1 : 0)); 40162306a36Sopenharmony_ci set_tx_desc_rts_stbc(pdesc, ((ptcb_desc->rts_stbc) ? 1 : 0)); 40262306a36Sopenharmony_ci 40362306a36Sopenharmony_ci set_tx_desc_rts_rate(pdesc, ptcb_desc->rts_rate); 40462306a36Sopenharmony_ci set_tx_desc_rts_bandwidth(pdesc, 0); 40562306a36Sopenharmony_ci set_tx_desc_rts_sub_carrier(pdesc, ptcb_desc->rts_sc); 40662306a36Sopenharmony_ci set_tx_desc_rts_short(pdesc, ((ptcb_desc->rts_rate <= 40762306a36Sopenharmony_ci DESC_RATE54M) ? 40862306a36Sopenharmony_ci (ptcb_desc->rts_use_shortpreamble ? 1 : 0) 40962306a36Sopenharmony_ci : (ptcb_desc->rts_use_shortgi ? 1 : 0))); 41062306a36Sopenharmony_ci 41162306a36Sopenharmony_ci 41262306a36Sopenharmony_ci /* Set Bandwidth and sub-channel settings. */ 41362306a36Sopenharmony_ci if (bw_40) { 41462306a36Sopenharmony_ci if (ptcb_desc->packet_bw) { 41562306a36Sopenharmony_ci set_tx_desc_tx_bandwidth(pdesc, 1); 41662306a36Sopenharmony_ci /* use duplicated mode */ 41762306a36Sopenharmony_ci set_tx_desc_tx_sub_carrier(pdesc, 0); 41862306a36Sopenharmony_ci } else { 41962306a36Sopenharmony_ci set_tx_desc_tx_bandwidth(pdesc, 0); 42062306a36Sopenharmony_ci set_tx_desc_tx_sub_carrier(pdesc, 42162306a36Sopenharmony_ci mac->cur_40_prime_sc); 42262306a36Sopenharmony_ci } 42362306a36Sopenharmony_ci } else { 42462306a36Sopenharmony_ci set_tx_desc_tx_bandwidth(pdesc, 0); 42562306a36Sopenharmony_ci set_tx_desc_tx_sub_carrier(pdesc, 0); 42662306a36Sopenharmony_ci } 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_ci /* 3 Fill necessary field in First Descriptor */ 42962306a36Sopenharmony_ci /*DWORD 0*/ 43062306a36Sopenharmony_ci set_tx_desc_linip(pdesc, 0); 43162306a36Sopenharmony_ci set_tx_desc_offset(pdesc, 32); 43262306a36Sopenharmony_ci set_tx_desc_pkt_size(pdesc, (u16)skb->len); 43362306a36Sopenharmony_ci 43462306a36Sopenharmony_ci /*DWORD 1*/ 43562306a36Sopenharmony_ci set_tx_desc_ra_brsr_id(pdesc, ptcb_desc->ratr_index); 43662306a36Sopenharmony_ci 43762306a36Sopenharmony_ci /* Fill security related */ 43862306a36Sopenharmony_ci if (info->control.hw_key) { 43962306a36Sopenharmony_ci struct ieee80211_key_conf *keyconf; 44062306a36Sopenharmony_ci 44162306a36Sopenharmony_ci keyconf = info->control.hw_key; 44262306a36Sopenharmony_ci switch (keyconf->cipher) { 44362306a36Sopenharmony_ci case WLAN_CIPHER_SUITE_WEP40: 44462306a36Sopenharmony_ci case WLAN_CIPHER_SUITE_WEP104: 44562306a36Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x1); 44662306a36Sopenharmony_ci break; 44762306a36Sopenharmony_ci case WLAN_CIPHER_SUITE_TKIP: 44862306a36Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x2); 44962306a36Sopenharmony_ci break; 45062306a36Sopenharmony_ci case WLAN_CIPHER_SUITE_CCMP: 45162306a36Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x3); 45262306a36Sopenharmony_ci break; 45362306a36Sopenharmony_ci default: 45462306a36Sopenharmony_ci set_tx_desc_sec_type(pdesc, 0x0); 45562306a36Sopenharmony_ci break; 45662306a36Sopenharmony_ci 45762306a36Sopenharmony_ci } 45862306a36Sopenharmony_ci } 45962306a36Sopenharmony_ci 46062306a36Sopenharmony_ci /* Set Packet ID */ 46162306a36Sopenharmony_ci set_tx_desc_packet_id(pdesc, 0); 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_ci /* We will assign magement queue to BK. */ 46462306a36Sopenharmony_ci set_tx_desc_queue_sel(pdesc, fw_qsel); 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_ci /* Alwasy enable all rate fallback range */ 46762306a36Sopenharmony_ci set_tx_desc_data_rate_fb_limit(pdesc, 0x1F); 46862306a36Sopenharmony_ci 46962306a36Sopenharmony_ci /* Fix: I don't kown why hw use 6.5M to tx when set it */ 47062306a36Sopenharmony_ci set_tx_desc_user_rate(pdesc, 47162306a36Sopenharmony_ci ptcb_desc->use_driver_rate ? 1 : 0); 47262306a36Sopenharmony_ci 47362306a36Sopenharmony_ci /* Set NON_QOS bit. */ 47462306a36Sopenharmony_ci if (!ieee80211_is_data_qos(fc)) 47562306a36Sopenharmony_ci set_tx_desc_non_qos(pdesc, 1); 47662306a36Sopenharmony_ci 47762306a36Sopenharmony_ci } 47862306a36Sopenharmony_ci 47962306a36Sopenharmony_ci /* Fill fields that are required to be initialized 48062306a36Sopenharmony_ci * in all of the descriptors */ 48162306a36Sopenharmony_ci /*DWORD 0 */ 48262306a36Sopenharmony_ci set_tx_desc_first_seg(pdesc, (firstseg ? 1 : 0)); 48362306a36Sopenharmony_ci set_tx_desc_last_seg(pdesc, (lastseg ? 1 : 0)); 48462306a36Sopenharmony_ci 48562306a36Sopenharmony_ci /* DWORD 7 */ 48662306a36Sopenharmony_ci set_tx_desc_tx_buffer_size(pdesc, (u16)skb->len); 48762306a36Sopenharmony_ci 48862306a36Sopenharmony_ci /* DOWRD 8 */ 48962306a36Sopenharmony_ci set_tx_desc_tx_buffer_address(pdesc, mapping); 49062306a36Sopenharmony_ci 49162306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, "\n"); 49262306a36Sopenharmony_ci} 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_civoid rtl92se_tx_fill_cmddesc(struct ieee80211_hw *hw, u8 *pdesc8, 49562306a36Sopenharmony_ci bool firstseg, bool lastseg, struct sk_buff *skb) 49662306a36Sopenharmony_ci{ 49762306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 49862306a36Sopenharmony_ci struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw)); 49962306a36Sopenharmony_ci struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw)); 50062306a36Sopenharmony_ci struct rtl_tcb_desc *tcb_desc = (struct rtl_tcb_desc *)(skb->cb); 50162306a36Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 50262306a36Sopenharmony_ci 50362306a36Sopenharmony_ci dma_addr_t mapping = dma_map_single(&rtlpci->pdev->dev, skb->data, 50462306a36Sopenharmony_ci skb->len, DMA_TO_DEVICE); 50562306a36Sopenharmony_ci 50662306a36Sopenharmony_ci if (dma_mapping_error(&rtlpci->pdev->dev, mapping)) { 50762306a36Sopenharmony_ci rtl_dbg(rtlpriv, COMP_SEND, DBG_TRACE, 50862306a36Sopenharmony_ci "DMA mapping error\n"); 50962306a36Sopenharmony_ci return; 51062306a36Sopenharmony_ci } 51162306a36Sopenharmony_ci /* Clear all status */ 51262306a36Sopenharmony_ci CLEAR_PCI_TX_DESC_CONTENT(pdesc, TX_CMDDESC_SIZE_RTL8192S); 51362306a36Sopenharmony_ci 51462306a36Sopenharmony_ci /* This bit indicate this packet is used for FW download. */ 51562306a36Sopenharmony_ci if (tcb_desc->cmd_or_init == DESC_PACKET_TYPE_INIT) { 51662306a36Sopenharmony_ci /* For firmware download we only need to set LINIP */ 51762306a36Sopenharmony_ci set_tx_desc_linip(pdesc, tcb_desc->last_inipkt); 51862306a36Sopenharmony_ci 51962306a36Sopenharmony_ci /* 92SE must set as 1 for firmware download HW DMA error */ 52062306a36Sopenharmony_ci set_tx_desc_first_seg(pdesc, 1); 52162306a36Sopenharmony_ci set_tx_desc_last_seg(pdesc, 1); 52262306a36Sopenharmony_ci 52362306a36Sopenharmony_ci /* 92SE need not to set TX packet size when firmware download */ 52462306a36Sopenharmony_ci set_tx_desc_pkt_size(pdesc, (u16)(skb->len)); 52562306a36Sopenharmony_ci set_tx_desc_tx_buffer_size(pdesc, (u16)(skb->len)); 52662306a36Sopenharmony_ci set_tx_desc_tx_buffer_address(pdesc, mapping); 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci wmb(); 52962306a36Sopenharmony_ci set_tx_desc_own(pdesc, 1); 53062306a36Sopenharmony_ci } else { /* H2C Command Desc format (Host TXCMD) */ 53162306a36Sopenharmony_ci /* 92SE must set as 1 for firmware download HW DMA error */ 53262306a36Sopenharmony_ci set_tx_desc_first_seg(pdesc, 1); 53362306a36Sopenharmony_ci set_tx_desc_last_seg(pdesc, 1); 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci set_tx_desc_offset(pdesc, 0x20); 53662306a36Sopenharmony_ci 53762306a36Sopenharmony_ci /* Buffer size + command header */ 53862306a36Sopenharmony_ci set_tx_desc_pkt_size(pdesc, (u16)(skb->len)); 53962306a36Sopenharmony_ci /* Fixed queue of H2C command */ 54062306a36Sopenharmony_ci set_tx_desc_queue_sel(pdesc, 0x13); 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_ci le32p_replace_bits((__le32 *)skb->data, rtlhal->h2c_txcmd_seq, 54362306a36Sopenharmony_ci GENMASK(30, 24)); 54462306a36Sopenharmony_ci set_tx_desc_tx_buffer_size(pdesc, (u16)(skb->len)); 54562306a36Sopenharmony_ci set_tx_desc_tx_buffer_address(pdesc, mapping); 54662306a36Sopenharmony_ci 54762306a36Sopenharmony_ci wmb(); 54862306a36Sopenharmony_ci set_tx_desc_own(pdesc, 1); 54962306a36Sopenharmony_ci 55062306a36Sopenharmony_ci } 55162306a36Sopenharmony_ci} 55262306a36Sopenharmony_ci 55362306a36Sopenharmony_civoid rtl92se_set_desc(struct ieee80211_hw *hw, u8 *pdesc8, bool istx, 55462306a36Sopenharmony_ci u8 desc_name, u8 *val) 55562306a36Sopenharmony_ci{ 55662306a36Sopenharmony_ci __le32 *pdesc = (__le32 *)pdesc8; 55762306a36Sopenharmony_ci 55862306a36Sopenharmony_ci if (istx) { 55962306a36Sopenharmony_ci switch (desc_name) { 56062306a36Sopenharmony_ci case HW_DESC_OWN: 56162306a36Sopenharmony_ci wmb(); 56262306a36Sopenharmony_ci set_tx_desc_own(pdesc, 1); 56362306a36Sopenharmony_ci break; 56462306a36Sopenharmony_ci case HW_DESC_TX_NEXTDESC_ADDR: 56562306a36Sopenharmony_ci set_tx_desc_next_desc_address(pdesc, *(u32 *)val); 56662306a36Sopenharmony_ci break; 56762306a36Sopenharmony_ci default: 56862306a36Sopenharmony_ci WARN_ONCE(true, "rtl8192se: ERR txdesc :%d not processed\n", 56962306a36Sopenharmony_ci desc_name); 57062306a36Sopenharmony_ci break; 57162306a36Sopenharmony_ci } 57262306a36Sopenharmony_ci } else { 57362306a36Sopenharmony_ci switch (desc_name) { 57462306a36Sopenharmony_ci case HW_DESC_RXOWN: 57562306a36Sopenharmony_ci wmb(); 57662306a36Sopenharmony_ci set_rx_status_desc_own(pdesc, 1); 57762306a36Sopenharmony_ci break; 57862306a36Sopenharmony_ci case HW_DESC_RXBUFF_ADDR: 57962306a36Sopenharmony_ci set_rx_status__desc_buff_addr(pdesc, *(u32 *)val); 58062306a36Sopenharmony_ci break; 58162306a36Sopenharmony_ci case HW_DESC_RXPKT_LEN: 58262306a36Sopenharmony_ci set_rx_status_desc_pkt_len(pdesc, *(u32 *)val); 58362306a36Sopenharmony_ci break; 58462306a36Sopenharmony_ci case HW_DESC_RXERO: 58562306a36Sopenharmony_ci set_rx_status_desc_eor(pdesc, 1); 58662306a36Sopenharmony_ci break; 58762306a36Sopenharmony_ci default: 58862306a36Sopenharmony_ci WARN_ONCE(true, "rtl8192se: ERR rxdesc :%d not processed\n", 58962306a36Sopenharmony_ci desc_name); 59062306a36Sopenharmony_ci break; 59162306a36Sopenharmony_ci } 59262306a36Sopenharmony_ci } 59362306a36Sopenharmony_ci} 59462306a36Sopenharmony_ci 59562306a36Sopenharmony_ciu64 rtl92se_get_desc(struct ieee80211_hw *hw, 59662306a36Sopenharmony_ci u8 *desc8, bool istx, u8 desc_name) 59762306a36Sopenharmony_ci{ 59862306a36Sopenharmony_ci u32 ret = 0; 59962306a36Sopenharmony_ci __le32 *desc = (__le32 *)desc8; 60062306a36Sopenharmony_ci 60162306a36Sopenharmony_ci if (istx) { 60262306a36Sopenharmony_ci switch (desc_name) { 60362306a36Sopenharmony_ci case HW_DESC_OWN: 60462306a36Sopenharmony_ci ret = get_tx_desc_own(desc); 60562306a36Sopenharmony_ci break; 60662306a36Sopenharmony_ci case HW_DESC_TXBUFF_ADDR: 60762306a36Sopenharmony_ci ret = get_tx_desc_tx_buffer_address(desc); 60862306a36Sopenharmony_ci break; 60962306a36Sopenharmony_ci default: 61062306a36Sopenharmony_ci WARN_ONCE(true, "rtl8192se: ERR txdesc :%d not processed\n", 61162306a36Sopenharmony_ci desc_name); 61262306a36Sopenharmony_ci break; 61362306a36Sopenharmony_ci } 61462306a36Sopenharmony_ci } else { 61562306a36Sopenharmony_ci switch (desc_name) { 61662306a36Sopenharmony_ci case HW_DESC_OWN: 61762306a36Sopenharmony_ci ret = get_rx_status_desc_own(desc); 61862306a36Sopenharmony_ci break; 61962306a36Sopenharmony_ci case HW_DESC_RXPKT_LEN: 62062306a36Sopenharmony_ci ret = get_rx_status_desc_pkt_len(desc); 62162306a36Sopenharmony_ci break; 62262306a36Sopenharmony_ci case HW_DESC_RXBUFF_ADDR: 62362306a36Sopenharmony_ci ret = get_rx_status_desc_buff_addr(desc); 62462306a36Sopenharmony_ci break; 62562306a36Sopenharmony_ci default: 62662306a36Sopenharmony_ci WARN_ONCE(true, "rtl8192se: ERR rxdesc :%d not processed\n", 62762306a36Sopenharmony_ci desc_name); 62862306a36Sopenharmony_ci break; 62962306a36Sopenharmony_ci } 63062306a36Sopenharmony_ci } 63162306a36Sopenharmony_ci return ret; 63262306a36Sopenharmony_ci} 63362306a36Sopenharmony_ci 63462306a36Sopenharmony_civoid rtl92se_tx_polling(struct ieee80211_hw *hw, u8 hw_queue) 63562306a36Sopenharmony_ci{ 63662306a36Sopenharmony_ci struct rtl_priv *rtlpriv = rtl_priv(hw); 63762306a36Sopenharmony_ci rtl_write_word(rtlpriv, TP_POLL, BIT(0) << (hw_queue)); 63862306a36Sopenharmony_ci} 639