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