linux/drivers/net/wireless/realtek/rtlwifi/rtl8192cu/trx.c
<<
>>
Prefs
   1/******************************************************************************
   2 *
   3 * Copyright(c) 2009-2012  Realtek Corporation. All rights reserved.
   4 *
   5 * This program is free software; you can redistribute it and/or modify it
   6 * under the terms of version 2 of the GNU General Public License as
   7 * published by the Free Software Foundation.
   8 *
   9 * This program is distributed in the hope that it will be useful, but WITHOUT
  10 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12 * more details.
  13 *
  14 * The full GNU General Public License is included in this distribution in the
  15 * file called LICENSE.
  16 *
  17 * Contact Information:
  18 * wlanfae <wlanfae@realtek.com>
  19 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
  20 * Hsinchu 300, Taiwan.
  21 *
  22 * Larry Finger <Larry.Finger@lwfinger.net>
  23 *
  24 *****************************************************************************/
  25
  26#include "../wifi.h"
  27#include "../usb.h"
  28#include "../ps.h"
  29#include "../base.h"
  30#include "reg.h"
  31#include "def.h"
  32#include "phy.h"
  33#include "rf.h"
  34#include "dm.h"
  35#include "mac.h"
  36#include "trx.h"
  37#include "../rtl8192c/fw_common.h"
  38
  39static int _ConfigVerTOutEP(struct ieee80211_hw *hw)
  40{
  41        u8 ep_cfg, txqsele;
  42        u8 ep_nums = 0;
  43
  44        struct rtl_priv *rtlpriv = rtl_priv(hw);
  45        struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);
  46        struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);
  47
  48        rtlusb->out_queue_sel = 0;
  49        ep_cfg = rtl_read_byte(rtlpriv, REG_TEST_SIE_OPTIONAL);
  50        ep_cfg = (ep_cfg & USB_TEST_EP_MASK) >> USB_TEST_EP_SHIFT;
  51        switch (ep_cfg) {
  52        case 0:         /* 2 bulk OUT, 1 bulk IN */
  53        case 3:
  54                rtlusb->out_queue_sel  = TX_SELE_HQ | TX_SELE_LQ;
  55                ep_nums = 2;
  56                break;
  57        case 1: /* 1 bulk IN/OUT => map all endpoint to Low queue */
  58        case 2: /* 1 bulk IN, 1 bulk OUT => map all endpoint to High queue */
  59                txqsele = rtl_read_byte(rtlpriv, REG_TEST_USB_TXQS);
  60                if (txqsele & 0x0F) /* /map all endpoint to High queue */
  61                        rtlusb->out_queue_sel =  TX_SELE_HQ;
  62                else if (txqsele&0xF0) /* map all endpoint to Low queue */
  63                        rtlusb->out_queue_sel =  TX_SELE_LQ;
  64                ep_nums = 1;
  65                break;
  66        default:
  67                break;
  68        }
  69        return (rtlusb->out_ep_nums == ep_nums) ? 0 : -EINVAL;
  70}
  71
  72static int _ConfigVerNOutEP(struct ieee80211_hw *hw)
  73{
  74        u8 ep_cfg;
  75        u8 ep_nums = 0;
  76
  77        struct rtl_priv *rtlpriv = rtl_priv(hw);
  78        struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);
  79        struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);
  80
  81        rtlusb->out_queue_sel = 0;
  82        /* Normal and High queue */
  83        ep_cfg =  rtl_read_byte(rtlpriv, (REG_NORMAL_SIE_EP + 1));
  84        if (ep_cfg & USB_NORMAL_SIE_EP_MASK) {
  85                rtlusb->out_queue_sel |= TX_SELE_HQ;
  86                ep_nums++;
  87        }
  88        if ((ep_cfg >> USB_NORMAL_SIE_EP_SHIFT) & USB_NORMAL_SIE_EP_MASK) {
  89                rtlusb->out_queue_sel |= TX_SELE_NQ;
  90                ep_nums++;
  91        }
  92        /* Low queue */
  93        ep_cfg =  rtl_read_byte(rtlpriv, (REG_NORMAL_SIE_EP + 2));
  94        if (ep_cfg & USB_NORMAL_SIE_EP_MASK) {
  95                rtlusb->out_queue_sel |= TX_SELE_LQ;
  96                ep_nums++;
  97        }
  98        return (rtlusb->out_ep_nums == ep_nums) ? 0 : -EINVAL;
  99}
 100
 101static void _TwoOutEpMapping(struct ieee80211_hw *hw, bool bIsChipB,
 102                             bool  bwificfg, struct rtl_ep_map *ep_map)
 103{
 104        struct rtl_priv *rtlpriv = rtl_priv(hw);
 105
 106        if (bwificfg) { /* for WMM */
 107                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
 108                         "USB Chip-B & WMM Setting.....\n");
 109                ep_map->ep_mapping[RTL_TXQ_BE]  = 2;
 110                ep_map->ep_mapping[RTL_TXQ_BK]  = 3;
 111                ep_map->ep_mapping[RTL_TXQ_VI]  = 3;
 112                ep_map->ep_mapping[RTL_TXQ_VO] = 2;
 113                ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
 114                ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
 115                ep_map->ep_mapping[RTL_TXQ_HI]  = 2;
 116        } else { /* typical setting */
 117                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
 118                         "USB typical Setting.....\n");
 119                ep_map->ep_mapping[RTL_TXQ_BE]  = 3;
 120                ep_map->ep_mapping[RTL_TXQ_BK]  = 3;
 121                ep_map->ep_mapping[RTL_TXQ_VI]  = 2;
 122                ep_map->ep_mapping[RTL_TXQ_VO]  = 2;
 123                ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
 124                ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
 125                ep_map->ep_mapping[RTL_TXQ_HI]  = 2;
 126        }
 127}
 128
 129static void _ThreeOutEpMapping(struct ieee80211_hw *hw, bool  bwificfg,
 130                               struct rtl_ep_map *ep_map)
 131{
 132        struct rtl_priv *rtlpriv = rtl_priv(hw);
 133        if (bwificfg) { /* for WMM */
 134                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
 135                         "USB 3EP Setting for WMM.....\n");
 136                ep_map->ep_mapping[RTL_TXQ_BE]  = 5;
 137                ep_map->ep_mapping[RTL_TXQ_BK]  = 3;
 138                ep_map->ep_mapping[RTL_TXQ_VI]  = 3;
 139                ep_map->ep_mapping[RTL_TXQ_VO]  = 2;
 140                ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
 141                ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
 142                ep_map->ep_mapping[RTL_TXQ_HI]  = 2;
 143        } else { /* typical setting */
 144                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
 145                         "USB 3EP Setting for typical.....\n");
 146                ep_map->ep_mapping[RTL_TXQ_BE]  = 5;
 147                ep_map->ep_mapping[RTL_TXQ_BK]  = 5;
 148                ep_map->ep_mapping[RTL_TXQ_VI]  = 3;
 149                ep_map->ep_mapping[RTL_TXQ_VO]  = 2;
 150                ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
 151                ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
 152                ep_map->ep_mapping[RTL_TXQ_HI]  = 2;
 153        }
 154}
 155
 156static void _OneOutEpMapping(struct ieee80211_hw *hw, struct rtl_ep_map *ep_map)
 157{
 158        ep_map->ep_mapping[RTL_TXQ_BE]  = 2;
 159        ep_map->ep_mapping[RTL_TXQ_BK]  = 2;
 160        ep_map->ep_mapping[RTL_TXQ_VI]  = 2;
 161        ep_map->ep_mapping[RTL_TXQ_VO] = 2;
 162        ep_map->ep_mapping[RTL_TXQ_MGT] = 2;
 163        ep_map->ep_mapping[RTL_TXQ_BCN] = 2;
 164        ep_map->ep_mapping[RTL_TXQ_HI]  = 2;
 165}
 166static int _out_ep_mapping(struct ieee80211_hw *hw)
 167{
 168        int err = 0;
 169        bool bIsChipN, bwificfg = false;
 170        struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
 171        struct rtl_usb_priv *usb_priv = rtl_usbpriv(hw);
 172        struct rtl_usb *rtlusb = rtl_usbdev(usb_priv);
 173        struct rtl_ep_map *ep_map = &(rtlusb->ep_map);
 174
 175        bIsChipN = IS_NORMAL_CHIP(rtlhal->version);
 176        switch (rtlusb->out_ep_nums) {
 177        case 2:
 178                _TwoOutEpMapping(hw, bIsChipN, bwificfg, ep_map);
 179                break;
 180        case 3:
 181                /* Test chip doesn't support three out EPs. */
 182                if (!bIsChipN) {
 183                        err  =  -EINVAL;
 184                        goto err_out;
 185                }
 186                _ThreeOutEpMapping(hw, bIsChipN, ep_map);
 187                break;
 188        case 1:
 189                _OneOutEpMapping(hw, ep_map);
 190                break;
 191        default:
 192                err  =  -EINVAL;
 193                break;
 194        }
 195err_out:
 196        return err;
 197
 198}
 199/* endpoint mapping */
 200int  rtl8192cu_endpoint_mapping(struct ieee80211_hw *hw)
 201{
 202        struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
 203        int error = 0;
 204        if (likely(IS_NORMAL_CHIP(rtlhal->version)))
 205                error = _ConfigVerNOutEP(hw);
 206        else
 207                error = _ConfigVerTOutEP(hw);
 208        if (error)
 209                goto err_out;
 210        error = _out_ep_mapping(hw);
 211        if (error)
 212                goto err_out;
 213err_out:
 214        return error;
 215}
 216
 217u16 rtl8192cu_mq_to_hwq(__le16 fc, u16 mac80211_queue_index)
 218{
 219        u16 hw_queue_index;
 220
 221        if (unlikely(ieee80211_is_beacon(fc))) {
 222                hw_queue_index = RTL_TXQ_BCN;
 223                goto out;
 224        }
 225        if (ieee80211_is_mgmt(fc)) {
 226                hw_queue_index = RTL_TXQ_MGT;
 227                goto out;
 228        }
 229        switch (mac80211_queue_index) {
 230        case 0:
 231                hw_queue_index = RTL_TXQ_VO;
 232                break;
 233        case 1:
 234                hw_queue_index = RTL_TXQ_VI;
 235                break;
 236        case 2:
 237                hw_queue_index = RTL_TXQ_BE;
 238                break;
 239        case 3:
 240                hw_queue_index = RTL_TXQ_BK;
 241                break;
 242        default:
 243                hw_queue_index = RTL_TXQ_BE;
 244                WARN_ONCE(true, "rtl8192cu: QSLT_BE queue, skb_queue:%d\n",
 245                          mac80211_queue_index);
 246                break;
 247        }
 248out:
 249        return hw_queue_index;
 250}
 251
 252static enum rtl_desc_qsel _rtl8192cu_mq_to_descq(struct ieee80211_hw *hw,
 253                                         __le16 fc, u16 mac80211_queue_index)
 254{
 255        enum rtl_desc_qsel qsel;
 256        struct rtl_priv *rtlpriv = rtl_priv(hw);
 257
 258        if (unlikely(ieee80211_is_beacon(fc))) {
 259                qsel = QSLT_BEACON;
 260                goto out;
 261        }
 262        if (ieee80211_is_mgmt(fc)) {
 263                qsel = QSLT_MGNT;
 264                goto out;
 265        }
 266        switch (mac80211_queue_index) {
 267        case 0: /* VO */
 268                qsel = QSLT_VO;
 269                RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
 270                         "VO queue, set qsel = 0x%x\n", QSLT_VO);
 271                break;
 272        case 1: /* VI */
 273                qsel = QSLT_VI;
 274                RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
 275                         "VI queue, set qsel = 0x%x\n", QSLT_VI);
 276                break;
 277        case 3: /* BK */
 278                qsel = QSLT_BK;
 279                RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
 280                         "BK queue, set qsel = 0x%x\n", QSLT_BK);
 281                break;
 282        case 2: /* BE */
 283        default:
 284                qsel = QSLT_BE;
 285                RT_TRACE(rtlpriv, COMP_USB, DBG_DMESG,
 286                         "BE queue, set qsel = 0x%x\n", QSLT_BE);
 287                break;
 288        }
 289out:
 290        return qsel;
 291}
 292
 293/* =============================================================== */
 294
 295/*----------------------------------------------------------------------
 296 *
 297 *      Rx handler
 298 *
 299 *---------------------------------------------------------------------- */
 300bool rtl92cu_rx_query_desc(struct ieee80211_hw *hw,
 301                           struct rtl_stats *stats,
 302                           struct ieee80211_rx_status *rx_status,
 303                           u8 *pdesc, struct sk_buff *skb)
 304{
 305        struct rx_fwinfo_92c *p_drvinfo;
 306        struct rx_desc_92c *p_desc = (struct rx_desc_92c *)pdesc;
 307        u32 phystatus = GET_RX_DESC_PHY_STATUS(pdesc);
 308
 309        stats->length = (u16) GET_RX_DESC_PKT_LEN(pdesc);
 310        stats->rx_drvinfo_size = (u8)GET_RX_DESC_DRVINFO_SIZE(pdesc) *
 311                                 RX_DRV_INFO_SIZE_UNIT;
 312        stats->rx_bufshift = (u8) (GET_RX_DESC_SHIFT(pdesc) & 0x03);
 313        stats->icv = (u16) GET_RX_DESC_ICV(pdesc);
 314        stats->crc = (u16) GET_RX_DESC_CRC32(pdesc);
 315        stats->hwerror = (stats->crc | stats->icv);
 316        stats->decrypted = !GET_RX_DESC_SWDEC(pdesc);
 317        stats->rate = (u8) GET_RX_DESC_RX_MCS(pdesc);
 318        stats->shortpreamble = (u16) GET_RX_DESC_SPLCP(pdesc);
 319        stats->isampdu = (bool) (GET_RX_DESC_PAGGR(pdesc) == 1);
 320        stats->isfirst_ampdu = (bool)((GET_RX_DESC_PAGGR(pdesc) == 1)
 321                                   && (GET_RX_DESC_FAGGR(pdesc) == 1));
 322        stats->timestamp_low = GET_RX_DESC_TSFL(pdesc);
 323        stats->rx_is40Mhzpacket = (bool) GET_RX_DESC_BW(pdesc);
 324        stats->is_ht = (bool)GET_RX_DESC_RX_HT(pdesc);
 325        rx_status->freq = hw->conf.chandef.chan->center_freq;
 326        rx_status->band = hw->conf.chandef.chan->band;
 327        if (GET_RX_DESC_CRC32(pdesc))
 328                rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
 329        if (!GET_RX_DESC_SWDEC(pdesc))
 330                rx_status->flag |= RX_FLAG_DECRYPTED;
 331        if (GET_RX_DESC_BW(pdesc))
 332                rx_status->bw = RATE_INFO_BW_40;
 333        if (GET_RX_DESC_RX_HT(pdesc))
 334                rx_status->encoding = RX_ENC_HT;
 335        rx_status->flag |= RX_FLAG_MACTIME_START;
 336        if (stats->decrypted)
 337                rx_status->flag |= RX_FLAG_DECRYPTED;
 338        rx_status->rate_idx = rtlwifi_rate_mapping(hw, stats->is_ht,
 339                                                   false, stats->rate);
 340        rx_status->mactime = GET_RX_DESC_TSFL(pdesc);
 341        if (phystatus) {
 342                p_drvinfo = (struct rx_fwinfo_92c *)(skb->data +
 343                                                     stats->rx_bufshift);
 344                rtl92c_translate_rx_signal_stuff(hw, skb, stats, p_desc,
 345                                                 p_drvinfo);
 346        }
 347        /*rx_status->qual = stats->signal; */
 348        rx_status->signal = stats->recvsignalpower + 10;
 349        return true;
 350}
 351
 352#define RTL_RX_DRV_INFO_UNIT            8
 353
 354static void _rtl_rx_process(struct ieee80211_hw *hw, struct sk_buff *skb)
 355{
 356        struct ieee80211_rx_status *rx_status =
 357                 (struct ieee80211_rx_status *)IEEE80211_SKB_RXCB(skb);
 358        u32 skb_len, pkt_len, drvinfo_len;
 359        struct rtl_priv *rtlpriv = rtl_priv(hw);
 360        u8 *rxdesc;
 361        struct rtl_stats stats = {
 362                .signal = 0,
 363                .rate = 0,
 364        };
 365        struct rx_fwinfo_92c *p_drvinfo;
 366        bool bv;
 367        __le16 fc;
 368        struct ieee80211_hdr *hdr;
 369
 370        memset(rx_status, 0, sizeof(*rx_status));
 371        rxdesc  = skb->data;
 372        skb_len = skb->len;
 373        drvinfo_len = (GET_RX_DESC_DRVINFO_SIZE(rxdesc) * RTL_RX_DRV_INFO_UNIT);
 374        pkt_len         = GET_RX_DESC_PKT_LEN(rxdesc);
 375        /* TODO: Error recovery. drop this skb or something. */
 376        WARN_ON(skb_len < (pkt_len + RTL_RX_DESC_SIZE + drvinfo_len));
 377        stats.length = (u16) GET_RX_DESC_PKT_LEN(rxdesc);
 378        stats.rx_drvinfo_size = (u8)GET_RX_DESC_DRVINFO_SIZE(rxdesc) *
 379                                RX_DRV_INFO_SIZE_UNIT;
 380        stats.rx_bufshift = (u8) (GET_RX_DESC_SHIFT(rxdesc) & 0x03);
 381        stats.icv = (u16) GET_RX_DESC_ICV(rxdesc);
 382        stats.crc = (u16) GET_RX_DESC_CRC32(rxdesc);
 383        stats.hwerror = (stats.crc | stats.icv);
 384        stats.decrypted = !GET_RX_DESC_SWDEC(rxdesc);
 385        stats.rate = (u8) GET_RX_DESC_RX_MCS(rxdesc);
 386        stats.shortpreamble = (u16) GET_RX_DESC_SPLCP(rxdesc);
 387        stats.isampdu = (bool) ((GET_RX_DESC_PAGGR(rxdesc) == 1)
 388                                   && (GET_RX_DESC_FAGGR(rxdesc) == 1));
 389        stats.timestamp_low = GET_RX_DESC_TSFL(rxdesc);
 390        stats.rx_is40Mhzpacket = (bool) GET_RX_DESC_BW(rxdesc);
 391        stats.is_ht = (bool)GET_RX_DESC_RX_HT(rxdesc);
 392        /* TODO: is center_freq changed when doing scan? */
 393        /* TODO: Shall we add protection or just skip those two step? */
 394        rx_status->freq = hw->conf.chandef.chan->center_freq;
 395        rx_status->band = hw->conf.chandef.chan->band;
 396        if (GET_RX_DESC_CRC32(rxdesc))
 397                rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
 398        if (!GET_RX_DESC_SWDEC(rxdesc))
 399                rx_status->flag |= RX_FLAG_DECRYPTED;
 400        if (GET_RX_DESC_BW(rxdesc))
 401                rx_status->bw = RATE_INFO_BW_40;
 402        if (GET_RX_DESC_RX_HT(rxdesc))
 403                rx_status->encoding = RX_ENC_HT;
 404        /* Data rate */
 405        rx_status->rate_idx = rtlwifi_rate_mapping(hw, stats.is_ht,
 406                                                   false, stats.rate);
 407        /*  There is a phy status after this rx descriptor. */
 408        if (GET_RX_DESC_PHY_STATUS(rxdesc)) {
 409                p_drvinfo = (struct rx_fwinfo_92c *)(rxdesc + RTL_RX_DESC_SIZE);
 410                rtl92c_translate_rx_signal_stuff(hw, skb, &stats,
 411                                 (struct rx_desc_92c *)rxdesc, p_drvinfo);
 412        }
 413        skb_pull(skb, (drvinfo_len + RTL_RX_DESC_SIZE));
 414        hdr = (struct ieee80211_hdr *)(skb->data);
 415        fc = hdr->frame_control;
 416        bv = ieee80211_is_probe_resp(fc);
 417        if (bv)
 418                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
 419                         "Got probe response frame\n");
 420        if (ieee80211_is_beacon(fc))
 421                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Got beacon frame\n");
 422        if (ieee80211_is_data(fc))
 423                RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG, "Got data frame\n");
 424        RT_TRACE(rtlpriv, COMP_INIT, DBG_DMESG,
 425                 "Fram: fc = 0x%X addr1 = 0x%02X:0x%02X:0x%02X:0x%02X:0x%02X:0x%02X\n",
 426                 fc,
 427                 (u32)hdr->addr1[0], (u32)hdr->addr1[1],
 428                 (u32)hdr->addr1[2], (u32)hdr->addr1[3],
 429                 (u32)hdr->addr1[4], (u32)hdr->addr1[5]);
 430        memcpy(IEEE80211_SKB_RXCB(skb), rx_status, sizeof(*rx_status));
 431        ieee80211_rx(hw, skb);
 432}
 433
 434void  rtl8192cu_rx_hdl(struct ieee80211_hw *hw, struct sk_buff * skb)
 435{
 436        _rtl_rx_process(hw, skb);
 437}
 438
 439/*----------------------------------------------------------------------
 440 *
 441 *      Tx handler
 442 *
 443 *---------------------------------------------------------------------- */
 444void rtl8192c_tx_cleanup(struct ieee80211_hw *hw, struct sk_buff  *skb)
 445{
 446}
 447
 448int rtl8192c_tx_post_hdl(struct ieee80211_hw *hw, struct urb *urb,
 449                         struct sk_buff *skb)
 450{
 451        return 0;
 452}
 453
 454struct sk_buff *rtl8192c_tx_aggregate_hdl(struct ieee80211_hw *hw,
 455                                           struct sk_buff_head *list)
 456{
 457        return skb_dequeue(list);
 458}
 459
 460/*======================================== trx ===============================*/
 461
 462static void _rtl_fill_usb_tx_desc(u8 *txdesc)
 463{
 464        SET_TX_DESC_OWN(txdesc, 1);
 465        SET_TX_DESC_LAST_SEG(txdesc, 1);
 466        SET_TX_DESC_FIRST_SEG(txdesc, 1);
 467}
 468/**
 469 *      For HW recovery information
 470 */
 471static void _rtl_tx_desc_checksum(u8 *txdesc)
 472{
 473        __le16 *ptr = (__le16 *)txdesc;
 474        u16     checksum = 0;
 475        u32 index;
 476
 477        /* Clear first */
 478        SET_TX_DESC_TX_DESC_CHECKSUM(txdesc, 0);
 479        for (index = 0; index < 16; index++)
 480                checksum = checksum ^ le16_to_cpu(*(ptr + index));
 481        SET_TX_DESC_TX_DESC_CHECKSUM(txdesc, checksum);
 482}
 483
 484void rtl92cu_tx_fill_desc(struct ieee80211_hw *hw,
 485                          struct ieee80211_hdr *hdr, u8 *pdesc_tx,
 486                          u8 *pbd_desc_tx, struct ieee80211_tx_info *info,
 487                          struct ieee80211_sta *sta,
 488                          struct sk_buff *skb,
 489                          u8 queue_index,
 490                          struct rtl_tcb_desc *tcb_desc)
 491{
 492        struct rtl_priv *rtlpriv = rtl_priv(hw);
 493        struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
 494        struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
 495        bool defaultadapter = true;
 496        u8 *qc = ieee80211_get_qos_ctl(hdr);
 497        u8 tid = qc[0] & IEEE80211_QOS_CTL_TID_MASK;
 498        u16 seq_number;
 499        __le16 fc = hdr->frame_control;
 500        u8 rate_flag = info->control.rates[0].flags;
 501        u16 pktlen = skb->len;
 502        enum rtl_desc_qsel fw_qsel = _rtl8192cu_mq_to_descq(hw, fc,
 503                                                skb_get_queue_mapping(skb));
 504        u8 *txdesc;
 505
 506        seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;
 507        rtl_get_tcb_desc(hw, info, sta, skb, tcb_desc);
 508        txdesc = skb_push(skb, RTL_TX_HEADER_SIZE);
 509        memset(txdesc, 0, RTL_TX_HEADER_SIZE);
 510        SET_TX_DESC_PKT_SIZE(txdesc, pktlen);
 511        SET_TX_DESC_LINIP(txdesc, 0);
 512        SET_TX_DESC_PKT_OFFSET(txdesc, RTL_DUMMY_OFFSET);
 513        SET_TX_DESC_OFFSET(txdesc, RTL_TX_HEADER_SIZE);
 514        SET_TX_DESC_TX_RATE(txdesc, tcb_desc->hw_rate);
 515        if (tcb_desc->use_shortgi || tcb_desc->use_shortpreamble)
 516                SET_TX_DESC_DATA_SHORTGI(txdesc, 1);
 517        if (mac->tids[tid].agg.agg_state == RTL_AGG_ON &&
 518                    info->flags & IEEE80211_TX_CTL_AMPDU) {
 519                SET_TX_DESC_AGG_ENABLE(txdesc, 1);
 520                SET_TX_DESC_MAX_AGG_NUM(txdesc, 0x14);
 521        } else {
 522                SET_TX_DESC_AGG_BREAK(txdesc, 1);
 523        }
 524        SET_TX_DESC_SEQ(txdesc, seq_number);
 525        SET_TX_DESC_RTS_ENABLE(txdesc, ((tcb_desc->rts_enable &&
 526                               !tcb_desc->cts_enable) ? 1 : 0));
 527        SET_TX_DESC_HW_RTS_ENABLE(txdesc, ((tcb_desc->rts_enable ||
 528                                  tcb_desc->cts_enable) ? 1 : 0));
 529        SET_TX_DESC_CTS2SELF(txdesc, ((tcb_desc->cts_enable) ? 1 : 0));
 530        SET_TX_DESC_RTS_STBC(txdesc, ((tcb_desc->rts_stbc) ? 1 : 0));
 531        SET_TX_DESC_RTS_RATE(txdesc, tcb_desc->rts_rate);
 532        SET_TX_DESC_RTS_BW(txdesc, 0);
 533        SET_TX_DESC_RTS_SC(txdesc, tcb_desc->rts_sc);
 534        SET_TX_DESC_RTS_SHORT(txdesc,
 535                              ((tcb_desc->rts_rate <= DESC_RATE54M) ?
 536                               (tcb_desc->rts_use_shortpreamble ? 1 : 0)
 537                               : (tcb_desc->rts_use_shortgi ? 1 : 0)));
 538        if (mac->bw_40) {
 539                if (rate_flag & IEEE80211_TX_RC_DUP_DATA) {
 540                        SET_TX_DESC_DATA_BW(txdesc, 1);
 541                        SET_TX_DESC_DATA_SC(txdesc, 3);
 542                } else if(rate_flag & IEEE80211_TX_RC_40_MHZ_WIDTH){
 543                        SET_TX_DESC_DATA_BW(txdesc, 1);
 544                        SET_TX_DESC_DATA_SC(txdesc, mac->cur_40_prime_sc);
 545                } else {
 546                        SET_TX_DESC_DATA_BW(txdesc, 0);
 547                        SET_TX_DESC_DATA_SC(txdesc, 0);
 548                }
 549        } else {
 550                SET_TX_DESC_DATA_BW(txdesc, 0);
 551                SET_TX_DESC_DATA_SC(txdesc, 0);
 552        }
 553        rcu_read_lock();
 554        sta = ieee80211_find_sta(mac->vif, mac->bssid);
 555        if (sta) {
 556                u8 ampdu_density = sta->ht_cap.ampdu_density;
 557                SET_TX_DESC_AMPDU_DENSITY(txdesc, ampdu_density);
 558        }
 559        rcu_read_unlock();
 560        if (info->control.hw_key) {
 561                struct ieee80211_key_conf *keyconf = info->control.hw_key;
 562                switch (keyconf->cipher) {
 563                case WLAN_CIPHER_SUITE_WEP40:
 564                case WLAN_CIPHER_SUITE_WEP104:
 565                case WLAN_CIPHER_SUITE_TKIP:
 566                        SET_TX_DESC_SEC_TYPE(txdesc, 0x1);
 567                        break;
 568                case WLAN_CIPHER_SUITE_CCMP:
 569                        SET_TX_DESC_SEC_TYPE(txdesc, 0x3);
 570                        break;
 571                default:
 572                        SET_TX_DESC_SEC_TYPE(txdesc, 0x0);
 573                        break;
 574                }
 575        }
 576        SET_TX_DESC_PKT_ID(txdesc, 0);
 577        SET_TX_DESC_QUEUE_SEL(txdesc, fw_qsel);
 578        SET_TX_DESC_DATA_RATE_FB_LIMIT(txdesc, 0x1F);
 579        SET_TX_DESC_RTS_RATE_FB_LIMIT(txdesc, 0xF);
 580        SET_TX_DESC_DISABLE_FB(txdesc, 0);
 581        SET_TX_DESC_USE_RATE(txdesc, tcb_desc->use_driver_rate ? 1 : 0);
 582        if (ieee80211_is_data_qos(fc)) {
 583                if (mac->rdg_en) {
 584                        RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE,
 585                                 "Enable RDG function\n");
 586                        SET_TX_DESC_RDG_ENABLE(txdesc, 1);
 587                        SET_TX_DESC_HTC(txdesc, 1);
 588                }
 589        }
 590        if (rtlpriv->dm.useramask) {
 591                SET_TX_DESC_RATE_ID(txdesc, tcb_desc->ratr_index);
 592                SET_TX_DESC_MACID(txdesc, tcb_desc->mac_id);
 593        } else {
 594                SET_TX_DESC_RATE_ID(txdesc, 0xC + tcb_desc->ratr_index);
 595                SET_TX_DESC_MACID(txdesc, tcb_desc->ratr_index);
 596        }
 597        if ((!ieee80211_is_data_qos(fc)) && ppsc->leisure_ps &&
 598              ppsc->fwctrl_lps) {
 599                SET_TX_DESC_HWSEQ_EN(txdesc, 1);
 600                SET_TX_DESC_PKT_ID(txdesc, 8);
 601                if (!defaultadapter)
 602                        SET_TX_DESC_QOS(txdesc, 1);
 603        }
 604        if (ieee80211_has_morefrags(fc))
 605                SET_TX_DESC_MORE_FRAG(txdesc, 1);
 606        if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) ||
 607            is_broadcast_ether_addr(ieee80211_get_DA(hdr)))
 608                SET_TX_DESC_BMC(txdesc, 1);
 609        _rtl_fill_usb_tx_desc(txdesc);
 610        _rtl_tx_desc_checksum(txdesc);
 611        RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE, "==>\n");
 612}
 613
 614void rtl92cu_fill_fake_txdesc(struct ieee80211_hw *hw, u8 * pDesc,
 615                              u32 buffer_len, bool bIsPsPoll)
 616{
 617        /* Clear all status */
 618        memset(pDesc, 0, RTL_TX_HEADER_SIZE);
 619        SET_TX_DESC_FIRST_SEG(pDesc, 1); /* bFirstSeg; */
 620        SET_TX_DESC_LAST_SEG(pDesc, 1); /* bLastSeg; */
 621        SET_TX_DESC_OFFSET(pDesc, RTL_TX_HEADER_SIZE); /* Offset = 32 */
 622        SET_TX_DESC_PKT_SIZE(pDesc, buffer_len); /* Buffer size + command hdr */
 623        SET_TX_DESC_QUEUE_SEL(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */
 624        /* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error
 625         * vlaue by Hw. */
 626        if (bIsPsPoll) {
 627                SET_TX_DESC_NAV_USE_HDR(pDesc, 1);
 628        } else {
 629                SET_TX_DESC_HWSEQ_EN(pDesc, 1); /* Hw set sequence number */
 630                SET_TX_DESC_PKT_ID(pDesc, 0x100); /* set bit3 to 1. */
 631        }
 632        SET_TX_DESC_USE_RATE(pDesc, 1); /* use data rate which is set by Sw */
 633        SET_TX_DESC_OWN(pDesc, 1);
 634        SET_TX_DESC_TX_RATE(pDesc, DESC_RATE1M);
 635        _rtl_tx_desc_checksum(pDesc);
 636}
 637
 638void rtl92cu_tx_fill_cmddesc(struct ieee80211_hw *hw,
 639                             u8 *pdesc, bool firstseg,
 640                             bool lastseg, struct sk_buff *skb)
 641{
 642        struct rtl_priv *rtlpriv = rtl_priv(hw);
 643        u8 fw_queue = QSLT_BEACON;
 644        struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)(skb->data);
 645        __le16 fc = hdr->frame_control;
 646
 647        memset((void *)pdesc, 0, RTL_TX_HEADER_SIZE);
 648        if (firstseg)
 649                SET_TX_DESC_OFFSET(pdesc, RTL_TX_HEADER_SIZE);
 650        SET_TX_DESC_TX_RATE(pdesc, DESC_RATE1M);
 651        SET_TX_DESC_SEQ(pdesc, 0);
 652        SET_TX_DESC_LINIP(pdesc, 0);
 653        SET_TX_DESC_QUEUE_SEL(pdesc, fw_queue);
 654        SET_TX_DESC_FIRST_SEG(pdesc, 1);
 655        SET_TX_DESC_LAST_SEG(pdesc, 1);
 656        SET_TX_DESC_RATE_ID(pdesc, 7);
 657        SET_TX_DESC_MACID(pdesc, 0);
 658        SET_TX_DESC_OWN(pdesc, 1);
 659        SET_TX_DESC_PKT_SIZE(pdesc, (u16)skb->len);
 660        SET_TX_DESC_FIRST_SEG(pdesc, 1);
 661        SET_TX_DESC_LAST_SEG(pdesc, 1);
 662        SET_TX_DESC_OFFSET(pdesc, 0x20);
 663        SET_TX_DESC_USE_RATE(pdesc, 1);
 664        if (!ieee80211_is_data_qos(fc)) {
 665                SET_TX_DESC_HWSEQ_EN(pdesc, 1);
 666                SET_TX_DESC_PKT_ID(pdesc, 8);
 667        }
 668        RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD, "H2C Tx Cmd Content",
 669                      pdesc, RTL_TX_DESC_SIZE);
 670}
 671