drivers/net/wireless/realtek/rtlwifi/rtl8192cu/trx.c

   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
  39 static 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
  72 static 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
 101 static 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
 129 static 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
 156 static 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 }
 166 static 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         }
 195 err_out:
 196         return err;
 197
 198 }
 199 /* endpoint mapping */
 200 int  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;
 213 err_out:
 214         return error;
 215 }
 216
 217 u16 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         }
 248 out:
 249         return hw_queue_index;
 250 }
 251
 252 static 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         }
 289 out:
 290         return qsel;
 291 }
 292
 293 /* =============================================================== */
 294
 295 /*----------------------------------------------------------------------
 296  *
 297  *      Rx handler
 298  *
 299  *---------------------------------------------------------------------- */
 300 bool 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
 354 static 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         ieee80211_rx(hw, skb);
 431 }
 432
 433 void  rtl8192cu_rx_hdl(struct ieee80211_hw *hw, struct sk_buff * skb)
 434 {
 435         _rtl_rx_process(hw, skb);
 436 }
 437
 438 /*----------------------------------------------------------------------
 439  *
 440  *      Tx handler
 441  *
 442  *---------------------------------------------------------------------- */
 443 void rtl8192c_tx_cleanup(struct ieee80211_hw *hw, struct sk_buff  *skb)
 444 {
 445 }
 446
 447 int rtl8192c_tx_post_hdl(struct ieee80211_hw *hw, struct urb *urb,
 448                          struct sk_buff *skb)
 449 {
 450         return 0;
 451 }
 452
 453 struct sk_buff *rtl8192c_tx_aggregate_hdl(struct ieee80211_hw *hw,
 454                                            struct sk_buff_head *list)
 455 {
 456         return skb_dequeue(list);
 457 }
 458
 459 /*======================================== trx ===============================*/
 460
 461 static void _rtl_fill_usb_tx_desc(u8 *txdesc)
 462 {
 463         SET_TX_DESC_OWN(txdesc, 1);
 464         SET_TX_DESC_LAST_SEG(txdesc, 1);
 465         SET_TX_DESC_FIRST_SEG(txdesc, 1);
 466 }
 467 /**
 468  *      For HW recovery information
 469  */
 470 static void _rtl_tx_desc_checksum(u8 *txdesc)
 471 {
 472         __le16 *ptr = (__le16 *)txdesc;
 473         u16     checksum = 0;
 474         u32 index;
 475
 476         /* Clear first */
 477         SET_TX_DESC_TX_DESC_CHECKSUM(txdesc, 0);
 478         for (index = 0; index < 16; index++)
 479                 checksum = checksum ^ le16_to_cpu(*(ptr + index));
 480         SET_TX_DESC_TX_DESC_CHECKSUM(txdesc, checksum);
 481 }
 482
 483 void rtl92cu_tx_fill_desc(struct ieee80211_hw *hw,
 484                           struct ieee80211_hdr *hdr, u8 *pdesc_tx,
 485                           u8 *pbd_desc_tx, struct ieee80211_tx_info *info,
 486                           struct ieee80211_sta *sta,
 487                           struct sk_buff *skb,
 488                           u8 queue_index,
 489                           struct rtl_tcb_desc *tcb_desc)
 490 {
 491         struct rtl_priv *rtlpriv = rtl_priv(hw);
 492         struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
 493         struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
 494         bool defaultadapter = true;
 495         u8 *qc = ieee80211_get_qos_ctl(hdr);
 496         u8 tid = qc[0] & IEEE80211_QOS_CTL_TID_MASK;
 497         u16 seq_number;
 498         __le16 fc = hdr->frame_control;
 499         u8 rate_flag = info->control.rates[0].flags;
 500         u16 pktlen = skb->len;
 501         enum rtl_desc_qsel fw_qsel = _rtl8192cu_mq_to_descq(hw, fc,
 502                                                 skb_get_queue_mapping(skb));
 503         u8 *txdesc;
 504
 505         seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;
 506         rtl_get_tcb_desc(hw, info, sta, skb, tcb_desc);
 507         txdesc = skb_push(skb, RTL_TX_HEADER_SIZE);
 508         memset(txdesc, 0, RTL_TX_HEADER_SIZE);
 509         SET_TX_DESC_PKT_SIZE(txdesc, pktlen);
 510         SET_TX_DESC_LINIP(txdesc, 0);
 511         SET_TX_DESC_PKT_OFFSET(txdesc, RTL_DUMMY_OFFSET);
 512         SET_TX_DESC_OFFSET(txdesc, RTL_TX_HEADER_SIZE);
 513         SET_TX_DESC_TX_RATE(txdesc, tcb_desc->hw_rate);
 514         if (tcb_desc->use_shortgi || tcb_desc->use_shortpreamble)
 515                 SET_TX_DESC_DATA_SHORTGI(txdesc, 1);
 516         if (mac->tids[tid].agg.agg_state == RTL_AGG_ON &&
 517                     info->flags & IEEE80211_TX_CTL_AMPDU) {
 518                 SET_TX_DESC_AGG_ENABLE(txdesc, 1);
 519                 SET_TX_DESC_MAX_AGG_NUM(txdesc, 0x14);
 520         } else {
 521                 SET_TX_DESC_AGG_BREAK(txdesc, 1);
 522         }
 523         SET_TX_DESC_SEQ(txdesc, seq_number);
 524         SET_TX_DESC_RTS_ENABLE(txdesc, ((tcb_desc->rts_enable &&
 525                                !tcb_desc->cts_enable) ? 1 : 0));
 526         SET_TX_DESC_HW_RTS_ENABLE(txdesc, ((tcb_desc->rts_enable ||
 527                                   tcb_desc->cts_enable) ? 1 : 0));
 528         SET_TX_DESC_CTS2SELF(txdesc, ((tcb_desc->cts_enable) ? 1 : 0));
 529         SET_TX_DESC_RTS_STBC(txdesc, ((tcb_desc->rts_stbc) ? 1 : 0));
 530         SET_TX_DESC_RTS_RATE(txdesc, tcb_desc->rts_rate);
 531         SET_TX_DESC_RTS_BW(txdesc, 0);
 532         SET_TX_DESC_RTS_SC(txdesc, tcb_desc->rts_sc);
 533         SET_TX_DESC_RTS_SHORT(txdesc,
 534                               ((tcb_desc->rts_rate <= DESC_RATE54M) ?
 535                                (tcb_desc->rts_use_shortpreamble ? 1 : 0)
 536                                : (tcb_desc->rts_use_shortgi ? 1 : 0)));
 537         if (mac->bw_40) {
 538                 if (rate_flag & IEEE80211_TX_RC_DUP_DATA) {
 539                         SET_TX_DESC_DATA_BW(txdesc, 1);
 540                         SET_TX_DESC_DATA_SC(txdesc, 3);
 541                 } else if(rate_flag & IEEE80211_TX_RC_40_MHZ_WIDTH){
 542                         SET_TX_DESC_DATA_BW(txdesc, 1);
 543                         SET_TX_DESC_DATA_SC(txdesc, mac->cur_40_prime_sc);
 544                 } else {
 545                         SET_TX_DESC_DATA_BW(txdesc, 0);
 546                         SET_TX_DESC_DATA_SC(txdesc, 0);
 547                 }
 548         } else {
 549                 SET_TX_DESC_DATA_BW(txdesc, 0);
 550                 SET_TX_DESC_DATA_SC(txdesc, 0);
 551         }
 552         rcu_read_lock();
 553         sta = ieee80211_find_sta(mac->vif, mac->bssid);
 554         if (sta) {
 555                 u8 ampdu_density = sta->ht_cap.ampdu_density;
 556                 SET_TX_DESC_AMPDU_DENSITY(txdesc, ampdu_density);
 557         }
 558         rcu_read_unlock();
 559         if (info->control.hw_key) {
 560                 struct ieee80211_key_conf *keyconf = info->control.hw_key;
 561                 switch (keyconf->cipher) {
 562                 case WLAN_CIPHER_SUITE_WEP40:
 563                 case WLAN_CIPHER_SUITE_WEP104:
 564                 case WLAN_CIPHER_SUITE_TKIP:
 565                         SET_TX_DESC_SEC_TYPE(txdesc, 0x1);
 566                         break;
 567                 case WLAN_CIPHER_SUITE_CCMP:
 568                         SET_TX_DESC_SEC_TYPE(txdesc, 0x3);
 569                         break;
 570                 default:
 571                         SET_TX_DESC_SEC_TYPE(txdesc, 0x0);
 572                         break;
 573                 }
 574         }
 575         SET_TX_DESC_PKT_ID(txdesc, 0);
 576         SET_TX_DESC_QUEUE_SEL(txdesc, fw_qsel);
 577         SET_TX_DESC_DATA_RATE_FB_LIMIT(txdesc, 0x1F);
 578         SET_TX_DESC_RTS_RATE_FB_LIMIT(txdesc, 0xF);
 579         SET_TX_DESC_DISABLE_FB(txdesc, 0);
 580         SET_TX_DESC_USE_RATE(txdesc, tcb_desc->use_driver_rate ? 1 : 0);
 581         if (ieee80211_is_data_qos(fc)) {
 582                 if (mac->rdg_en) {
 583                         RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE,
 584                                  "Enable RDG function\n");
 585                         SET_TX_DESC_RDG_ENABLE(txdesc, 1);
 586                         SET_TX_DESC_HTC(txdesc, 1);
 587                 }
 588         }
 589         if (rtlpriv->dm.useramask) {
 590                 SET_TX_DESC_RATE_ID(txdesc, tcb_desc->ratr_index);
 591                 SET_TX_DESC_MACID(txdesc, tcb_desc->mac_id);
 592         } else {
 593                 SET_TX_DESC_RATE_ID(txdesc, 0xC + tcb_desc->ratr_index);
 594                 SET_TX_DESC_MACID(txdesc, tcb_desc->ratr_index);
 595         }
 596         if ((!ieee80211_is_data_qos(fc)) && ppsc->leisure_ps &&
 597               ppsc->fwctrl_lps) {
 598                 SET_TX_DESC_HWSEQ_EN(txdesc, 1);
 599                 SET_TX_DESC_PKT_ID(txdesc, 8);
 600                 if (!defaultadapter)
 601                         SET_TX_DESC_QOS(txdesc, 1);
 602         }
 603         if (ieee80211_has_morefrags(fc))
 604                 SET_TX_DESC_MORE_FRAG(txdesc, 1);
 605         if (is_multicast_ether_addr(ieee80211_get_DA(hdr)) ||
 606             is_broadcast_ether_addr(ieee80211_get_DA(hdr)))
 607                 SET_TX_DESC_BMC(txdesc, 1);
 608         _rtl_fill_usb_tx_desc(txdesc);
 609         _rtl_tx_desc_checksum(txdesc);
 610         RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE, "==>\n");
 611 }
 612
 613 void rtl92cu_fill_fake_txdesc(struct ieee80211_hw *hw, u8 * pDesc,
 614                               u32 buffer_len, bool bIsPsPoll)
 615 {
 616         /* Clear all status */
 617         memset(pDesc, 0, RTL_TX_HEADER_SIZE);
 618         SET_TX_DESC_FIRST_SEG(pDesc, 1); /* bFirstSeg; */
 619         SET_TX_DESC_LAST_SEG(pDesc, 1); /* bLastSeg; */
 620         SET_TX_DESC_OFFSET(pDesc, RTL_TX_HEADER_SIZE); /* Offset = 32 */
 621         SET_TX_DESC_PKT_SIZE(pDesc, buffer_len); /* Buffer size + command hdr */
 622         SET_TX_DESC_QUEUE_SEL(pDesc, QSLT_MGNT); /* Fixed queue of Mgnt queue */
 623         /* Set NAVUSEHDR to prevent Ps-poll AId filed to be changed to error
 624          * vlaue by Hw. */
 625         if (bIsPsPoll) {
 626                 SET_TX_DESC_NAV_USE_HDR(pDesc, 1);
 627         } else {
 628                 SET_TX_DESC_HWSEQ_EN(pDesc, 1); /* Hw set sequence number */
 629                 SET_TX_DESC_PKT_ID(pDesc, 0x100); /* set bit3 to 1. */
 630         }
 631         SET_TX_DESC_USE_RATE(pDesc, 1); /* use data rate which is set by Sw */
 632         SET_TX_DESC_OWN(pDesc, 1);
 633         SET_TX_DESC_TX_RATE(pDesc, DESC_RATE1M);
 634         _rtl_tx_desc_checksum(pDesc);
 635 }
 636
 637 void rtl92cu_tx_fill_cmddesc(struct ieee80211_hw *hw,
 638                              u8 *pdesc, bool firstseg,
 639                              bool lastseg, struct sk_buff *skb)
 640 {
 641         struct rtl_priv *rtlpriv = rtl_priv(hw);
 642         u8 fw_queue = QSLT_BEACON;
 643         struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)(skb->data);
 644         __le16 fc = hdr->frame_control;
 645
 646         memset((void *)pdesc, 0, RTL_TX_HEADER_SIZE);
 647         if (firstseg)
 648                 SET_TX_DESC_OFFSET(pdesc, RTL_TX_HEADER_SIZE);
 649         SET_TX_DESC_TX_RATE(pdesc, DESC_RATE1M);
 650         SET_TX_DESC_SEQ(pdesc, 0);
 651         SET_TX_DESC_LINIP(pdesc, 0);
 652         SET_TX_DESC_QUEUE_SEL(pdesc, fw_queue);
 653         SET_TX_DESC_FIRST_SEG(pdesc, 1);
 654         SET_TX_DESC_LAST_SEG(pdesc, 1);
 655         SET_TX_DESC_RATE_ID(pdesc, 7);
 656         SET_TX_DESC_MACID(pdesc, 0);
 657         SET_TX_DESC_OWN(pdesc, 1);
 658         SET_TX_DESC_PKT_SIZE(pdesc, (u16)skb->len);
 659         SET_TX_DESC_FIRST_SEG(pdesc, 1);
 660         SET_TX_DESC_LAST_SEG(pdesc, 1);
 661         SET_TX_DESC_OFFSET(pdesc, 0x20);
 662         SET_TX_DESC_USE_RATE(pdesc, 1);
 663         if (!ieee80211_is_data_qos(fc)) {
 664                 SET_TX_DESC_HWSEQ_EN(pdesc, 1);
 665                 SET_TX_DESC_PKT_ID(pdesc, 8);
 666         }
 667         RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD, "H2C Tx Cmd Content",
 668                       pdesc, RTL_TX_DESC_SIZE);
 669 }