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