trx.c

Go to the documentation of this file.

/******************************************************************************
 *
 * Copyright(c) 2009-2012  Realtek Corporation.
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program; if not, write to the Free Software Foundation, Inc.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
 *
 * The full GNU General Public License is included in this distribution in the
 * file called LICENSE.
 *
 * Contact Information:
 * wlanfae <[email protected]>
 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
 * Hsinchu 300, Taiwan.
 *
 * Larry Finger <[email protected]>
 *
 *****************************************************************************/

#include "../wifi.h"
#include "../pci.h"
#include "../base.h"
#include "reg.h"
#include "def.h"
#include "phy.h"
#include "fw.h"
#include "trx.h"
#include "led.h"

static u8 _rtl92se_map_hwqueue_to_fwqueue(struct sk_buff *skb,  u8 skb_queue)
{
    __le16 fc = rtl_get_fc(skb);

    if (unlikely(ieee80211_is_beacon(fc)))
        return QSLT_BEACON;
    if (ieee80211_is_mgmt(fc))
        return QSLT_MGNT;
    if (ieee80211_is_nullfunc(fc))
        return QSLT_HIGH;

    return skb->priority;
}

static u8 _rtl92s_query_rxpwrpercentage(char antpower)
{
    if ((antpower <= -100) || (antpower >= 20))
        return 0;
    else if (antpower >= 0)
        return 100;
    else
        return 100 + antpower;
}

static u8 _rtl92s_evm_db_to_percentage(char value)
{
    char ret_val;
    ret_val = value;

    if (ret_val >= 0)
        ret_val = 0;

    if (ret_val <= -33)
        ret_val = -33;

    ret_val = 0 - ret_val;
    ret_val *= 3;

    if (ret_val == 99)
        ret_val = 100;

    return ret_val;
}

static long _rtl92se_translate_todbm(struct ieee80211_hw *hw,
                     u8 signal_strength_index)
{
    long signal_power;

    signal_power = (long)((signal_strength_index + 1) >> 1);
    signal_power -= 95;
    return signal_power;
}

static long _rtl92se_signal_scale_mapping(struct ieee80211_hw *hw,
        long currsig)
{
    long retsig = 0;

    /* Step 1. Scale mapping. */
    if (currsig > 47)
        retsig = 100;
    else if (currsig > 14 && currsig <= 47)
        retsig = 100 - ((47 - currsig) * 3) / 2;
    else if (currsig > 2 && currsig <= 14)
        retsig = 48 - ((14 - currsig) * 15) / 7;
    else if (currsig >= 0)
        retsig = currsig * 9 + 1;

    return retsig;
}


static void _rtl92se_query_rxphystatus(struct ieee80211_hw *hw,
                       struct rtl_stats *pstats, u8 *pdesc,
                       struct rx_fwinfo *p_drvinfo,
                       bool packet_match_bssid,
                       bool packet_toself,
                       bool packet_beacon)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    struct phy_sts_cck_8192s_t *cck_buf;
    s8 rx_pwr_all = 0, rx_pwr[4];
    u8 rf_rx_num = 0, evm, pwdb_all;
    u8 i, max_spatial_stream;
    u32 rssi, total_rssi = 0;
    bool in_powersavemode = false;
    bool is_cck = pstats->is_cck;

    pstats->packet_matchbssid = packet_match_bssid;
    pstats->packet_toself = packet_toself;
    pstats->packet_beacon = packet_beacon;
    pstats->rx_mimo_signalquality[0] = -1;
    pstats->rx_mimo_signalquality[1] = -1;

    if (is_cck) {
        u8 report, cck_highpwr;
        cck_buf = (struct phy_sts_cck_8192s_t *)p_drvinfo;

        if (!in_powersavemode)
            cck_highpwr = (u8) rtl_get_bbreg(hw,
                        RFPGA0_XA_HSSIPARAMETER2,
                        0x200);
        else
            cck_highpwr = false;

        if (!cck_highpwr) {
            u8 cck_agc_rpt = cck_buf->cck_agc_rpt;
            report = cck_buf->cck_agc_rpt & 0xc0;
            report = report >> 6;
            switch (report) {
            case 0x3:
                rx_pwr_all = -40 - (cck_agc_rpt & 0x3e);
                break;
            case 0x2:
                rx_pwr_all = -20 - (cck_agc_rpt & 0x3e);
                break;
            case 0x1:
                rx_pwr_all = -2 - (cck_agc_rpt & 0x3e);
                break;
            case 0x0:
                rx_pwr_all = 14 - (cck_agc_rpt & 0x3e);
                break;
            }
        } else {
            u8 cck_agc_rpt = cck_buf->cck_agc_rpt;
            report = p_drvinfo->cfosho[0] & 0x60;
            report = report >> 5;
            switch (report) {
            case 0x3:
                rx_pwr_all = -40 - ((cck_agc_rpt & 0x1f) << 1);
                break;
            case 0x2:
                rx_pwr_all = -20 - ((cck_agc_rpt & 0x1f) << 1);
                break;
            case 0x1:
                rx_pwr_all = -2 - ((cck_agc_rpt & 0x1f) << 1);
                break;
            case 0x0:
                rx_pwr_all = 14 - ((cck_agc_rpt & 0x1f) << 1);
                break;
            }
        }

        pwdb_all = _rtl92s_query_rxpwrpercentage(rx_pwr_all);

        /* CCK gain is smaller than OFDM/MCS gain,  */
        /* so we add gain diff by experiences, the val is 6 */
        pwdb_all += 6;
        if (pwdb_all > 100)
            pwdb_all = 100;
        /* modify the offset to make the same gain index with OFDM. */
        if (pwdb_all > 34 && pwdb_all <= 42)
            pwdb_all -= 2;
        else if (pwdb_all > 26 && pwdb_all <= 34)
            pwdb_all -= 6;
        else if (pwdb_all > 14 && pwdb_all <= 26)
            pwdb_all -= 8;
        else if (pwdb_all > 4 && pwdb_all <= 14)
            pwdb_all -= 4;

        pstats->rx_pwdb_all = pwdb_all;
        pstats->recvsignalpower = rx_pwr_all;

        if (packet_match_bssid) {
            u8 sq;
            if (pstats->rx_pwdb_all > 40) {
                sq = 100;
            } else {
                sq = cck_buf->sq_rpt;
                if (sq > 64)
                    sq = 0;
                else if (sq < 20)
                    sq = 100;
                else
                    sq = ((64 - sq) * 100) / 44;
            }

            pstats->signalquality = sq;
            pstats->rx_mimo_signalquality[0] = sq;
            pstats->rx_mimo_signalquality[1] = -1;
        }
    } else {
        rtlpriv->dm.rfpath_rxenable[0] =
            rtlpriv->dm.rfpath_rxenable[1] = true;
        for (i = RF90_PATH_A; i < RF90_PATH_MAX; i++) {
            if (rtlpriv->dm.rfpath_rxenable[i])
                rf_rx_num++;

            rx_pwr[i] = ((p_drvinfo->gain_trsw[i] &
                    0x3f) * 2) - 110;
            rssi = _rtl92s_query_rxpwrpercentage(rx_pwr[i]);
            total_rssi += rssi;
            rtlpriv->stats.rx_snr_db[i] =
                     (long)(p_drvinfo->rxsnr[i] / 2);

            if (packet_match_bssid)
                pstats->rx_mimo_signalstrength[i] = (u8) rssi;
        }

        rx_pwr_all = ((p_drvinfo->pwdb_all >> 1) & 0x7f) - 110;
        pwdb_all = _rtl92s_query_rxpwrpercentage(rx_pwr_all);
        pstats->rx_pwdb_all = pwdb_all;
        pstats->rxpower = rx_pwr_all;
        pstats->recvsignalpower = rx_pwr_all;

        if (pstats->is_ht && pstats->rate >= DESC92_RATEMCS8 &&
            pstats->rate <= DESC92_RATEMCS15)
            max_spatial_stream = 2;
        else
            max_spatial_stream = 1;

        for (i = 0; i < max_spatial_stream; i++) {
            evm = _rtl92s_evm_db_to_percentage(p_drvinfo->rxevm[i]);

            if (packet_match_bssid) {
                if (i == 0)
                    pstats->signalquality = (u8)(evm &
                                 0xff);
                pstats->rx_mimo_signalquality[i] =
                             (u8) (evm & 0xff);
            }
        }
    }

    if (is_cck)
        pstats->signalstrength = (u8)(_rtl92se_signal_scale_mapping(hw,
                     pwdb_all));
    else if (rf_rx_num != 0)
        pstats->signalstrength = (u8) (_rtl92se_signal_scale_mapping(hw,
                total_rssi /= rf_rx_num));
}

static void _rtl92se_process_ui_rssi(struct ieee80211_hw *hw,
                     struct rtl_stats *pstats)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    struct rtl_phy *rtlphy = &(rtlpriv->phy);
    u8 rfpath;
    u32 last_rssi, tmpval;

    if (pstats->packet_toself || pstats->packet_beacon) {
        rtlpriv->stats.rssi_calculate_cnt++;

        if (rtlpriv->stats.ui_rssi.total_num++ >=
            PHY_RSSI_SLID_WIN_MAX) {
            rtlpriv->stats.ui_rssi.total_num =
                     PHY_RSSI_SLID_WIN_MAX;
            last_rssi = rtlpriv->stats.ui_rssi.elements[
                rtlpriv->stats.ui_rssi.index];
            rtlpriv->stats.ui_rssi.total_val -= last_rssi;
        }

        rtlpriv->stats.ui_rssi.total_val += pstats->signalstrength;
        rtlpriv->stats.ui_rssi.elements[rtlpriv->stats.ui_rssi.index++]
             = pstats->signalstrength;

        if (rtlpriv->stats.ui_rssi.index >= PHY_RSSI_SLID_WIN_MAX)
            rtlpriv->stats.ui_rssi.index = 0;

        tmpval = rtlpriv->stats.ui_rssi.total_val /
            rtlpriv->stats.ui_rssi.total_num;
        rtlpriv->stats.signal_strength = _rtl92se_translate_todbm(hw,
                                (u8) tmpval);
        pstats->rssi = rtlpriv->stats.signal_strength;
    }

    if (!pstats->is_cck && pstats->packet_toself) {
        for (rfpath = RF90_PATH_A; rfpath < rtlphy->num_total_rfpath;
             rfpath++) {
            if (rtlpriv->stats.rx_rssi_percentage[rfpath] == 0) {
                rtlpriv->stats.rx_rssi_percentage[rfpath] =
                    pstats->rx_mimo_signalstrength[rfpath];

            }

            if (pstats->rx_mimo_signalstrength[rfpath] >
                rtlpriv->stats.rx_rssi_percentage[rfpath]) {
                rtlpriv->stats.rx_rssi_percentage[rfpath] =
                    ((rtlpriv->stats.rx_rssi_percentage[rfpath]
                    * (RX_SMOOTH_FACTOR - 1)) +
                    (pstats->rx_mimo_signalstrength[rfpath])) /
                    (RX_SMOOTH_FACTOR);

                rtlpriv->stats.rx_rssi_percentage[rfpath] =
                    rtlpriv->stats.rx_rssi_percentage[rfpath]
                    + 1;
            } else {
                rtlpriv->stats.rx_rssi_percentage[rfpath] =
                    ((rtlpriv->stats.rx_rssi_percentage[rfpath]
                    * (RX_SMOOTH_FACTOR - 1)) +
                    (pstats->rx_mimo_signalstrength[rfpath])) /
                    (RX_SMOOTH_FACTOR);
            }

        }
    }
}

static void _rtl92se_update_rxsignalstatistics(struct ieee80211_hw *hw,
                           struct rtl_stats *pstats)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    int weighting = 0;

    if (rtlpriv->stats.recv_signal_power == 0)
        rtlpriv->stats.recv_signal_power = pstats->recvsignalpower;

    if (pstats->recvsignalpower > rtlpriv->stats.recv_signal_power)
        weighting = 5;
    else if (pstats->recvsignalpower < rtlpriv->stats.recv_signal_power)
        weighting = (-5);

    rtlpriv->stats.recv_signal_power = (rtlpriv->stats.recv_signal_power * 5
                       + pstats->recvsignalpower +
                       weighting) / 6;
}

static void _rtl92se_process_pwdb(struct ieee80211_hw *hw,
                  struct rtl_stats *pstats)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
    long undec_sm_pwdb = 0;

    if (mac->opmode == NL80211_IFTYPE_ADHOC) {
        return;
    } else {
        undec_sm_pwdb =
            rtlpriv->dm.undecorated_smoothed_pwdb;
    }

    if (pstats->packet_toself || pstats->packet_beacon) {
        if (undec_sm_pwdb < 0)
            undec_sm_pwdb = pstats->rx_pwdb_all;

        if (pstats->rx_pwdb_all > (u32) undec_sm_pwdb) {
            undec_sm_pwdb =
                (((undec_sm_pwdb) *
                (RX_SMOOTH_FACTOR - 1)) +
                (pstats->rx_pwdb_all)) / (RX_SMOOTH_FACTOR);

            undec_sm_pwdb = undec_sm_pwdb + 1;
        } else {
            undec_sm_pwdb = (((undec_sm_pwdb) *
                  (RX_SMOOTH_FACTOR - 1)) + (pstats->rx_pwdb_all)) /
                  (RX_SMOOTH_FACTOR);
        }

        rtlpriv->dm.undecorated_smoothed_pwdb = undec_sm_pwdb;
        _rtl92se_update_rxsignalstatistics(hw, pstats);
    }
}

static void rtl_92s_process_streams(struct ieee80211_hw *hw,
                    struct rtl_stats *pstats)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    u32 stream;

    for (stream = 0; stream < 2; stream++) {
        if (pstats->rx_mimo_signalquality[stream] != -1) {
            if (rtlpriv->stats.rx_evm_percentage[stream] == 0) {
                rtlpriv->stats.rx_evm_percentage[stream] =
                    pstats->rx_mimo_signalquality[stream];
            }

            rtlpriv->stats.rx_evm_percentage[stream] =
                ((rtlpriv->stats.rx_evm_percentage[stream] *
                    (RX_SMOOTH_FACTOR - 1)) +
                 (pstats->rx_mimo_signalquality[stream] *
                    1)) / (RX_SMOOTH_FACTOR);
        }
    }
}

static void _rtl92se_process_ui_link_quality(struct ieee80211_hw *hw,
                         struct rtl_stats *pstats)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    u32 last_evm = 0, tmpval;

    if (pstats->signalquality != 0) {
        if (pstats->packet_toself || pstats->packet_beacon) {

            if (rtlpriv->stats.ui_link_quality.total_num++ >=
                PHY_LINKQUALITY_SLID_WIN_MAX) {
                rtlpriv->stats.ui_link_quality.total_num =
                    PHY_LINKQUALITY_SLID_WIN_MAX;
                last_evm =
                    rtlpriv->stats.ui_link_quality.elements[
                    rtlpriv->stats.ui_link_quality.index];
                rtlpriv->stats.ui_link_quality.total_val -=
                    last_evm;
            }

            rtlpriv->stats.ui_link_quality.total_val +=
                pstats->signalquality;
            rtlpriv->stats.ui_link_quality.elements[
                rtlpriv->stats.ui_link_quality.index++] =
                pstats->signalquality;

            if (rtlpriv->stats.ui_link_quality.index >=
                PHY_LINKQUALITY_SLID_WIN_MAX)
                rtlpriv->stats.ui_link_quality.index = 0;

            tmpval = rtlpriv->stats.ui_link_quality.total_val /
                rtlpriv->stats.ui_link_quality.total_num;
            rtlpriv->stats.signal_quality = tmpval;

            rtlpriv->stats.last_sigstrength_inpercent = tmpval;

            rtl_92s_process_streams(hw, pstats);

        }
    }
}

static void _rtl92se_process_phyinfo(struct ieee80211_hw *hw,
                     u8 *buffer,
                     struct rtl_stats *pcurrent_stats)
{

    if (!pcurrent_stats->packet_matchbssid &&
        !pcurrent_stats->packet_beacon)
        return;

    _rtl92se_process_ui_rssi(hw, pcurrent_stats);
    _rtl92se_process_pwdb(hw, pcurrent_stats);
    _rtl92se_process_ui_link_quality(hw, pcurrent_stats);
}

static void _rtl92se_translate_rx_signal_stuff(struct ieee80211_hw *hw,
        struct sk_buff *skb, struct rtl_stats *pstats,
        u8 *pdesc, struct rx_fwinfo *p_drvinfo)
{
    struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
    struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));

    struct ieee80211_hdr *hdr;
    u8 *tmp_buf;
    u8 *praddr;
    __le16 fc;
    u16 type, cfc;
    bool packet_matchbssid, packet_toself, packet_beacon;

    tmp_buf = skb->data + pstats->rx_drvinfo_size + pstats->rx_bufshift;

    hdr = (struct ieee80211_hdr *)tmp_buf;
    fc = hdr->frame_control;
    cfc = le16_to_cpu(fc);
    type = WLAN_FC_GET_TYPE(fc);
    praddr = hdr->addr1;

    packet_matchbssid = ((IEEE80211_FTYPE_CTL != type) &&
         ether_addr_equal(mac->bssid,
                  (cfc & IEEE80211_FCTL_TODS) ? hdr->addr1 :
                  (cfc & IEEE80211_FCTL_FROMDS) ? hdr->addr2 :
                  hdr->addr3) &&
         (!pstats->hwerror) && (!pstats->crc) && (!pstats->icv));

    packet_toself = packet_matchbssid &&
        ether_addr_equal(praddr, rtlefuse->dev_addr);

    if (ieee80211_is_beacon(fc))
        packet_beacon = true;

    _rtl92se_query_rxphystatus(hw, pstats, pdesc, p_drvinfo,
            packet_matchbssid, packet_toself, packet_beacon);
    _rtl92se_process_phyinfo(hw, tmp_buf, pstats);
}

bool rtl92se_rx_query_desc(struct ieee80211_hw *hw, struct rtl_stats *stats,
               struct ieee80211_rx_status *rx_status, u8 *pdesc,
               struct sk_buff *skb)
{
    struct rx_fwinfo *p_drvinfo;
    u32 phystatus = (u32)GET_RX_STATUS_DESC_PHY_STATUS(pdesc);
    struct ieee80211_hdr *hdr;
    bool first_ampdu = false;

    stats->length = (u16)GET_RX_STATUS_DESC_PKT_LEN(pdesc);
    stats->rx_drvinfo_size = (u8)GET_RX_STATUS_DESC_DRVINFO_SIZE(pdesc) * 8;
    stats->rx_bufshift = (u8)(GET_RX_STATUS_DESC_SHIFT(pdesc) & 0x03);
    stats->icv = (u16)GET_RX_STATUS_DESC_ICV(pdesc);
    stats->crc = (u16)GET_RX_STATUS_DESC_CRC32(pdesc);
    stats->hwerror = (u16)(stats->crc | stats->icv);
    stats->decrypted = !GET_RX_STATUS_DESC_SWDEC(pdesc);

    stats->rate = (u8)GET_RX_STATUS_DESC_RX_MCS(pdesc);
    stats->shortpreamble = (u16)GET_RX_STATUS_DESC_SPLCP(pdesc);
    stats->isampdu = (bool)(GET_RX_STATUS_DESC_PAGGR(pdesc) == 1);
    stats->isfirst_ampdu = (bool) ((GET_RX_STATUS_DESC_PAGGR(pdesc) == 1)
                   && (GET_RX_STATUS_DESC_FAGGR(pdesc) == 1));
    stats->timestamp_low = GET_RX_STATUS_DESC_TSFL(pdesc);
    stats->rx_is40Mhzpacket = (bool)GET_RX_STATUS_DESC_BW(pdesc);
    stats->is_ht = (bool)GET_RX_STATUS_DESC_RX_HT(pdesc);
    stats->is_cck = SE_RX_HAL_IS_CCK_RATE(pdesc);

    if (stats->hwerror)
        return false;

    rx_status->freq = hw->conf.channel->center_freq;
    rx_status->band = hw->conf.channel->band;

    hdr = (struct ieee80211_hdr *)(skb->data + stats->rx_drvinfo_size
          + stats->rx_bufshift);

    if (stats->crc)
        rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;

    if (stats->rx_is40Mhzpacket)
        rx_status->flag |= RX_FLAG_40MHZ;

    if (stats->is_ht)
        rx_status->flag |= RX_FLAG_HT;

    rx_status->flag |= RX_FLAG_MACTIME_MPDU;

    /* hw will set stats->decrypted true, if it finds the
     * frame is open data frame or mgmt frame,
     * hw will not decrypt robust managment frame
     * for IEEE80211w but still set stats->decrypted
     * true, so here we should set it back to undecrypted
     * for IEEE80211w frame, and mac80211 sw will help
     * to decrypt it */
    if (stats->decrypted) {
        if ((ieee80211_is_robust_mgmt_frame(hdr)) &&
            (ieee80211_has_protected(hdr->frame_control)))
            rx_status->flag &= ~RX_FLAG_DECRYPTED;
        else
            rx_status->flag |= RX_FLAG_DECRYPTED;
    }

    rx_status->rate_idx = rtlwifi_rate_mapping(hw,
                  stats->is_ht, stats->rate, first_ampdu);

    rx_status->mactime = stats->timestamp_low;
    if (phystatus) {
        p_drvinfo = (struct rx_fwinfo *)(skb->data +
                         stats->rx_bufshift);
        _rtl92se_translate_rx_signal_stuff(hw, skb, stats, pdesc,
                           p_drvinfo);
    }

    /*rx_status->qual = stats->signal; */
    rx_status->signal = stats->rssi + 10;
    /*rx_status->noise = -stats->noise; */

    return true;
}

void rtl92se_tx_fill_desc(struct ieee80211_hw *hw,
        struct ieee80211_hdr *hdr, u8 *pdesc_tx,
        struct ieee80211_tx_info *info,
        struct ieee80211_sta *sta,
        struct sk_buff *skb,
        u8 hw_queue, struct rtl_tcb_desc *ptcb_desc)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
    struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
    struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
    u8 *pdesc = pdesc_tx;
    u16 seq_number;
    __le16 fc = hdr->frame_control;
    u8 reserved_macid = 0;
    u8 fw_qsel = _rtl92se_map_hwqueue_to_fwqueue(skb, hw_queue);
    bool firstseg = (!(hdr->seq_ctrl & cpu_to_le16(IEEE80211_SCTL_FRAG)));
    bool lastseg = (!(hdr->frame_control &
            cpu_to_le16(IEEE80211_FCTL_MOREFRAGS)));
    dma_addr_t mapping = pci_map_single(rtlpci->pdev, skb->data, skb->len,
            PCI_DMA_TODEVICE);
    u8 bw_40 = 0;

    if (mac->opmode == NL80211_IFTYPE_STATION) {
        bw_40 = mac->bw_40;
    } else if (mac->opmode == NL80211_IFTYPE_AP ||
        mac->opmode == NL80211_IFTYPE_ADHOC) {
        if (sta)
            bw_40 = sta->ht_cap.cap &
                    IEEE80211_HT_CAP_SUP_WIDTH_20_40;
    }

    seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;

    rtl_get_tcb_desc(hw, info, sta, skb, ptcb_desc);

    CLEAR_PCI_TX_DESC_CONTENT(pdesc, TX_DESC_SIZE_RTL8192S);

    if (firstseg) {
        if (rtlpriv->dm.useramask) {
            /* set txdesc macId */
            if (ptcb_desc->mac_id < 32) {
                SET_TX_DESC_MACID(pdesc, ptcb_desc->mac_id);
                reserved_macid |= ptcb_desc->mac_id;
            }
        }
        SET_TX_DESC_RSVD_MACID(pdesc, reserved_macid);

        SET_TX_DESC_TXHT(pdesc, ((ptcb_desc->hw_rate >=
                 DESC92_RATEMCS0) ? 1 : 0));

        if (rtlhal->version == VERSION_8192S_ACUT) {
            if (ptcb_desc->hw_rate == DESC92_RATE1M ||
                ptcb_desc->hw_rate  == DESC92_RATE2M ||
                ptcb_desc->hw_rate == DESC92_RATE5_5M ||
                ptcb_desc->hw_rate == DESC92_RATE11M) {
                ptcb_desc->hw_rate = DESC92_RATE12M;
            }
        }

        SET_TX_DESC_TX_RATE(pdesc, ptcb_desc->hw_rate);

        if (ptcb_desc->use_shortgi || ptcb_desc->use_shortpreamble)
            SET_TX_DESC_TX_SHORT(pdesc, 0);

        /* Aggregation related */
        if (info->flags & IEEE80211_TX_CTL_AMPDU)
            SET_TX_DESC_AGG_ENABLE(pdesc, 1);

        /* For AMPDU, we must insert SSN into TX_DESC */
        SET_TX_DESC_SEQ(pdesc, seq_number);

        /* Protection mode related */
        /* For 92S, if RTS/CTS are set, HW will execute RTS. */
        /* We choose only one protection mode to execute */
        SET_TX_DESC_RTS_ENABLE(pdesc, ((ptcb_desc->rts_enable &&
                !ptcb_desc->cts_enable) ? 1 : 0));
        SET_TX_DESC_CTS_ENABLE(pdesc, ((ptcb_desc->cts_enable) ?
                       1 : 0));
        SET_TX_DESC_RTS_STBC(pdesc, ((ptcb_desc->rts_stbc) ? 1 : 0));

        SET_TX_DESC_RTS_RATE(pdesc, ptcb_desc->rts_rate);
        SET_TX_DESC_RTS_BANDWIDTH(pdesc, 0);
        SET_TX_DESC_RTS_SUB_CARRIER(pdesc, ptcb_desc->rts_sc);
        SET_TX_DESC_RTS_SHORT(pdesc, ((ptcb_desc->rts_rate <=
               DESC92_RATE54M) ?
               (ptcb_desc->rts_use_shortpreamble ? 1 : 0)
               : (ptcb_desc->rts_use_shortgi ? 1 : 0)));


        /* Set Bandwidth and sub-channel settings. */
        if (bw_40) {
            if (ptcb_desc->packet_bw) {
                SET_TX_DESC_TX_BANDWIDTH(pdesc, 1);
                /* use duplicated mode */
                SET_TX_DESC_TX_SUB_CARRIER(pdesc, 0);
            } else {
                SET_TX_DESC_TX_BANDWIDTH(pdesc, 0);
                SET_TX_DESC_TX_SUB_CARRIER(pdesc,
                           mac->cur_40_prime_sc);
            }
        } else {
            SET_TX_DESC_TX_BANDWIDTH(pdesc, 0);
            SET_TX_DESC_TX_SUB_CARRIER(pdesc, 0);
        }

        /* 3 Fill necessary field in First Descriptor */
        /*DWORD 0*/
        SET_TX_DESC_LINIP(pdesc, 0);
        SET_TX_DESC_OFFSET(pdesc, 32);
        SET_TX_DESC_PKT_SIZE(pdesc, (u16) skb->len);

        /*DWORD 1*/
        SET_TX_DESC_RA_BRSR_ID(pdesc, ptcb_desc->ratr_index);

        /* Fill security related */
        if (info->control.hw_key) {
            struct ieee80211_key_conf *keyconf;

            keyconf = info->control.hw_key;
            switch (keyconf->cipher) {
            case WLAN_CIPHER_SUITE_WEP40:
            case WLAN_CIPHER_SUITE_WEP104:
                SET_TX_DESC_SEC_TYPE(pdesc, 0x1);
                break;
            case WLAN_CIPHER_SUITE_TKIP:
                SET_TX_DESC_SEC_TYPE(pdesc, 0x2);
                break;
            case WLAN_CIPHER_SUITE_CCMP:
                SET_TX_DESC_SEC_TYPE(pdesc, 0x3);
                break;
            default:
                SET_TX_DESC_SEC_TYPE(pdesc, 0x0);
                break;

            }
        }

        /* Set Packet ID */
        SET_TX_DESC_PACKET_ID(pdesc, 0);

        /* We will assign magement queue to BK. */
        SET_TX_DESC_QUEUE_SEL(pdesc, fw_qsel);

        /* Alwasy enable all rate fallback range */
        SET_TX_DESC_DATA_RATE_FB_LIMIT(pdesc, 0x1F);

        /* Fix: I don't kown why hw use 6.5M to tx when set it */
        SET_TX_DESC_USER_RATE(pdesc,
                      ptcb_desc->use_driver_rate ? 1 : 0);

        /* Set NON_QOS bit. */
        if (!ieee80211_is_data_qos(fc))
            SET_TX_DESC_NON_QOS(pdesc, 1);

    }

    /* Fill fields that are required to be initialized
     * in all of the descriptors */
    /*DWORD 0 */
    SET_TX_DESC_FIRST_SEG(pdesc, (firstseg ? 1 : 0));
    SET_TX_DESC_LAST_SEG(pdesc, (lastseg ? 1 : 0));

    /* DWORD 7 */
    SET_TX_DESC_TX_BUFFER_SIZE(pdesc, (u16) skb->len);

    /* DOWRD 8 */
    SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc, mapping);

    RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE, "\n");
}

void rtl92se_tx_fill_cmddesc(struct ieee80211_hw *hw, u8 *pdesc,
    bool firstseg, bool lastseg, struct sk_buff *skb)
{
    struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
    struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
    struct rtl_tcb_desc *tcb_desc = (struct rtl_tcb_desc *)(skb->cb);

    dma_addr_t mapping = pci_map_single(rtlpci->pdev, skb->data, skb->len,
            PCI_DMA_TODEVICE);

    /* Clear all status */
    CLEAR_PCI_TX_DESC_CONTENT(pdesc, TX_CMDDESC_SIZE_RTL8192S);

    /* This bit indicate this packet is used for FW download. */
    if (tcb_desc->cmd_or_init == DESC_PACKET_TYPE_INIT) {
        /* For firmware downlaod we only need to set LINIP */
        SET_TX_DESC_LINIP(pdesc, tcb_desc->last_inipkt);

        /* 92SE must set as 1 for firmware download HW DMA error */
        SET_TX_DESC_FIRST_SEG(pdesc, 1);
        SET_TX_DESC_LAST_SEG(pdesc, 1);

        /* 92SE need not to set TX packet size when firmware download */
        SET_TX_DESC_PKT_SIZE(pdesc, (u16)(skb->len));
        SET_TX_DESC_TX_BUFFER_SIZE(pdesc, (u16)(skb->len));
        SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc, mapping);

        wmb();
        SET_TX_DESC_OWN(pdesc, 1);
    } else { /* H2C Command Desc format (Host TXCMD) */
        /* 92SE must set as 1 for firmware download HW DMA error */
        SET_TX_DESC_FIRST_SEG(pdesc, 1);
        SET_TX_DESC_LAST_SEG(pdesc, 1);

        SET_TX_DESC_OFFSET(pdesc, 0x20);

        /* Buffer size + command header */
        SET_TX_DESC_PKT_SIZE(pdesc, (u16)(skb->len));
        /* Fixed queue of H2C command */
        SET_TX_DESC_QUEUE_SEL(pdesc, 0x13);

        SET_BITS_TO_LE_4BYTE(skb->data, 24, 7, rtlhal->h2c_txcmd_seq);

        SET_TX_DESC_TX_BUFFER_SIZE(pdesc, (u16)(skb->len));
        SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc, mapping);

        wmb();
        SET_TX_DESC_OWN(pdesc, 1);

    }
}

void rtl92se_set_desc(u8 *pdesc, bool istx, u8 desc_name, u8 *val)
{
    if (istx) {
        switch (desc_name) {
        case HW_DESC_OWN:
            wmb();
            SET_TX_DESC_OWN(pdesc, 1);
            break;
        case HW_DESC_TX_NEXTDESC_ADDR:
            SET_TX_DESC_NEXT_DESC_ADDRESS(pdesc, *(u32 *) val);
            break;
        default:
            RT_ASSERT(false, "ERR txdesc :%d not process\n",
                  desc_name);
            break;
        }
    } else {
        switch (desc_name) {
        case HW_DESC_RXOWN:
            wmb();
            SET_RX_STATUS_DESC_OWN(pdesc, 1);
            break;
        case HW_DESC_RXBUFF_ADDR:
            SET_RX_STATUS__DESC_BUFF_ADDR(pdesc, *(u32 *) val);
            break;
        case HW_DESC_RXPKT_LEN:
            SET_RX_STATUS_DESC_PKT_LEN(pdesc, *(u32 *) val);
            break;
        case HW_DESC_RXERO:
            SET_RX_STATUS_DESC_EOR(pdesc, 1);
            break;
        default:
            RT_ASSERT(false, "ERR rxdesc :%d not process\n",
                  desc_name);
            break;
        }
    }
}

u32 rtl92se_get_desc(u8 *desc, bool istx, u8 desc_name)
{
    u32 ret = 0;

    if (istx) {
        switch (desc_name) {
        case HW_DESC_OWN:
            ret = GET_TX_DESC_OWN(desc);
            break;
        case HW_DESC_TXBUFF_ADDR:
            ret = GET_TX_DESC_TX_BUFFER_ADDRESS(desc);
            break;
        default:
            RT_ASSERT(false, "ERR txdesc :%d not process\n",
                  desc_name);
            break;
        }
    } else {
        switch (desc_name) {
        case HW_DESC_OWN:
            ret = GET_RX_STATUS_DESC_OWN(desc);
            break;
        case HW_DESC_RXPKT_LEN:
            ret = GET_RX_STATUS_DESC_PKT_LEN(desc);
            break;
        default:
            RT_ASSERT(false, "ERR rxdesc :%d not process\n",
                  desc_name);
            break;
        }
    }
    return ret;
}

void rtl92se_tx_polling(struct ieee80211_hw *hw, u8 hw_queue)
{
    struct rtl_priv *rtlpriv = rtl_priv(hw);
    rtl_write_word(rtlpriv, TP_POLL, BIT(0) << (hw_queue));
}