1 /******************************************************************************
3 * Copyright(c) 2009-2010 Realtek Corporation.
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.
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
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
18 * The full GNU General Public License is included in this distribution in the
19 * file called LICENSE.
21 * Contact Information:
22 * wlanfae <wlanfae@realtek.com>
23 * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
24 * Hsinchu 300, Taiwan.
26 * Larry Finger <Larry.Finger@lwfinger.net>
28 *****************************************************************************/
40 static u8
_rtl92se_map_hwqueue_to_fwqueue(struct sk_buff
*skb
, u8 skb_queue
)
42 __le16 fc
= rtl_get_fc(skb
);
44 if (unlikely(ieee80211_is_beacon(fc
)))
46 if (ieee80211_is_mgmt(fc
))
48 if (ieee80211_is_nullfunc(fc
))
54 static u8
_rtl92s_query_rxpwrpercentage(char antpower
)
56 if ((antpower
<= -100) || (antpower
>= 20))
58 else if (antpower
>= 0)
61 return 100 + antpower
;
64 static u8
_rtl92s_evm_db_to_percentage(char value
)
75 ret_val
= 0 - ret_val
;
84 static long _rtl92se_translate_todbm(struct ieee80211_hw
*hw
,
85 u8 signal_strength_index
)
89 signal_power
= (long)((signal_strength_index
+ 1) >> 1);
94 static long _rtl92se_signal_scale_mapping(struct ieee80211_hw
*hw
,
99 /* Step 1. Scale mapping. */
102 else if (currsig
> 14 && currsig
<= 47)
103 retsig
= 100 - ((47 - currsig
) * 3) / 2;
104 else if (currsig
> 2 && currsig
<= 14)
105 retsig
= 48 - ((14 - currsig
) * 15) / 7;
106 else if (currsig
>= 0)
107 retsig
= currsig
* 9 + 1;
113 static void _rtl92se_query_rxphystatus(struct ieee80211_hw
*hw
,
114 struct rtl_stats
*pstats
, u8
*pdesc
,
115 struct rx_fwinfo
*p_drvinfo
,
116 bool packet_match_bssid
,
120 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
121 struct phy_sts_cck_8192s_t
*cck_buf
;
122 s8 rx_pwr_all
= 0, rx_pwr
[4];
123 u8 rf_rx_num
= 0, evm
, pwdb_all
;
124 u8 i
, max_spatial_stream
;
125 u32 rssi
, total_rssi
= 0;
126 bool in_powersavemode
= false;
129 is_cck_rate
= RX_HAL_IS_CCK_RATE(pdesc
);
130 pstats
->packet_matchbssid
= packet_match_bssid
;
131 pstats
->packet_toself
= packet_toself
;
132 pstats
->is_cck
= is_cck_rate
;
133 pstats
->packet_beacon
= packet_beacon
;
134 pstats
->is_cck
= is_cck_rate
;
135 pstats
->rx_mimo_signalquality
[0] = -1;
136 pstats
->rx_mimo_signalquality
[1] = -1;
139 u8 report
, cck_highpwr
;
140 cck_buf
= (struct phy_sts_cck_8192s_t
*)p_drvinfo
;
142 if (!in_powersavemode
)
143 cck_highpwr
= (u8
) rtl_get_bbreg(hw
,
144 RFPGA0_XA_HSSIPARAMETER2
,
150 u8 cck_agc_rpt
= cck_buf
->cck_agc_rpt
;
151 report
= cck_buf
->cck_agc_rpt
& 0xc0;
152 report
= report
>> 6;
155 rx_pwr_all
= -40 - (cck_agc_rpt
& 0x3e);
158 rx_pwr_all
= -20 - (cck_agc_rpt
& 0x3e);
161 rx_pwr_all
= -2 - (cck_agc_rpt
& 0x3e);
164 rx_pwr_all
= 14 - (cck_agc_rpt
& 0x3e);
168 u8 cck_agc_rpt
= cck_buf
->cck_agc_rpt
;
169 report
= p_drvinfo
->cfosho
[0] & 0x60;
170 report
= report
>> 5;
173 rx_pwr_all
= -40 - ((cck_agc_rpt
& 0x1f) << 1);
176 rx_pwr_all
= -20 - ((cck_agc_rpt
& 0x1f) << 1);
179 rx_pwr_all
= -2 - ((cck_agc_rpt
& 0x1f) << 1);
182 rx_pwr_all
= 14 - ((cck_agc_rpt
& 0x1f) << 1);
187 pwdb_all
= _rtl92s_query_rxpwrpercentage(rx_pwr_all
);
189 /* CCK gain is smaller than OFDM/MCS gain, */
190 /* so we add gain diff by experiences, the val is 6 */
194 /* modify the offset to make the same gain index with OFDM. */
195 if (pwdb_all
> 34 && pwdb_all
<= 42)
197 else if (pwdb_all
> 26 && pwdb_all
<= 34)
199 else if (pwdb_all
> 14 && pwdb_all
<= 26)
201 else if (pwdb_all
> 4 && pwdb_all
<= 14)
204 pstats
->rx_pwdb_all
= pwdb_all
;
205 pstats
->recvsignalpower
= rx_pwr_all
;
207 if (packet_match_bssid
) {
209 if (pstats
->rx_pwdb_all
> 40) {
212 sq
= cck_buf
->sq_rpt
;
218 sq
= ((64 - sq
) * 100) / 44;
221 pstats
->signalquality
= sq
;
222 pstats
->rx_mimo_signalquality
[0] = sq
;
223 pstats
->rx_mimo_signalquality
[1] = -1;
226 rtlpriv
->dm
.rfpath_rxenable
[0] =
227 rtlpriv
->dm
.rfpath_rxenable
[1] = true;
228 for (i
= RF90_PATH_A
; i
< RF90_PATH_MAX
; i
++) {
229 if (rtlpriv
->dm
.rfpath_rxenable
[i
])
232 rx_pwr
[i
] = ((p_drvinfo
->gain_trsw
[i
] &
234 rssi
= _rtl92s_query_rxpwrpercentage(rx_pwr
[i
]);
236 rtlpriv
->stats
.rx_snr_db
[i
] =
237 (long)(p_drvinfo
->rxsnr
[i
] / 2);
239 if (packet_match_bssid
)
240 pstats
->rx_mimo_signalstrength
[i
] = (u8
) rssi
;
243 rx_pwr_all
= ((p_drvinfo
->pwdb_all
>> 1) & 0x7f) - 110;
244 pwdb_all
= _rtl92s_query_rxpwrpercentage(rx_pwr_all
);
245 pstats
->rx_pwdb_all
= pwdb_all
;
246 pstats
->rxpower
= rx_pwr_all
;
247 pstats
->recvsignalpower
= rx_pwr_all
;
249 if (GET_RX_STATUS_DESC_RX_HT(pdesc
) &&
250 GET_RX_STATUS_DESC_RX_MCS(pdesc
) >= DESC92_RATEMCS8
&&
251 GET_RX_STATUS_DESC_RX_MCS(pdesc
) <= DESC92_RATEMCS15
)
252 max_spatial_stream
= 2;
254 max_spatial_stream
= 1;
256 for (i
= 0; i
< max_spatial_stream
; i
++) {
257 evm
= _rtl92s_evm_db_to_percentage(p_drvinfo
->rxevm
[i
]);
259 if (packet_match_bssid
) {
261 pstats
->signalquality
= (u8
)(evm
&
263 pstats
->rx_mimo_signalquality
[i
] =
270 pstats
->signalstrength
= (u8
)(_rtl92se_signal_scale_mapping(hw
,
272 else if (rf_rx_num
!= 0)
273 pstats
->signalstrength
= (u8
) (_rtl92se_signal_scale_mapping(hw
,
274 total_rssi
/= rf_rx_num
));
277 static void _rtl92se_process_ui_rssi(struct ieee80211_hw
*hw
,
278 struct rtl_stats
*pstats
)
280 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
281 struct rtl_phy
*rtlphy
= &(rtlpriv
->phy
);
283 u32 last_rssi
, tmpval
;
285 if (pstats
->packet_toself
|| pstats
->packet_beacon
) {
286 rtlpriv
->stats
.rssi_calculate_cnt
++;
288 if (rtlpriv
->stats
.ui_rssi
.total_num
++ >=
289 PHY_RSSI_SLID_WIN_MAX
) {
290 rtlpriv
->stats
.ui_rssi
.total_num
=
291 PHY_RSSI_SLID_WIN_MAX
;
292 last_rssi
= rtlpriv
->stats
.ui_rssi
.elements
[
293 rtlpriv
->stats
.ui_rssi
.index
];
294 rtlpriv
->stats
.ui_rssi
.total_val
-= last_rssi
;
297 rtlpriv
->stats
.ui_rssi
.total_val
+= pstats
->signalstrength
;
298 rtlpriv
->stats
.ui_rssi
.elements
[rtlpriv
->stats
.ui_rssi
.index
++]
299 = pstats
->signalstrength
;
301 if (rtlpriv
->stats
.ui_rssi
.index
>= PHY_RSSI_SLID_WIN_MAX
)
302 rtlpriv
->stats
.ui_rssi
.index
= 0;
304 tmpval
= rtlpriv
->stats
.ui_rssi
.total_val
/
305 rtlpriv
->stats
.ui_rssi
.total_num
;
306 rtlpriv
->stats
.signal_strength
= _rtl92se_translate_todbm(hw
,
308 pstats
->rssi
= rtlpriv
->stats
.signal_strength
;
311 if (!pstats
->is_cck
&& pstats
->packet_toself
) {
312 for (rfpath
= RF90_PATH_A
; rfpath
< rtlphy
->num_total_rfpath
;
314 if (rtlpriv
->stats
.rx_rssi_percentage
[rfpath
] == 0) {
315 rtlpriv
->stats
.rx_rssi_percentage
[rfpath
] =
316 pstats
->rx_mimo_signalstrength
[rfpath
];
320 if (pstats
->rx_mimo_signalstrength
[rfpath
] >
321 rtlpriv
->stats
.rx_rssi_percentage
[rfpath
]) {
322 rtlpriv
->stats
.rx_rssi_percentage
[rfpath
] =
323 ((rtlpriv
->stats
.rx_rssi_percentage
[rfpath
]
324 * (RX_SMOOTH_FACTOR
- 1)) +
325 (pstats
->rx_mimo_signalstrength
[rfpath
])) /
328 rtlpriv
->stats
.rx_rssi_percentage
[rfpath
] =
329 rtlpriv
->stats
.rx_rssi_percentage
[rfpath
]
332 rtlpriv
->stats
.rx_rssi_percentage
[rfpath
] =
333 ((rtlpriv
->stats
.rx_rssi_percentage
[rfpath
]
334 * (RX_SMOOTH_FACTOR
- 1)) +
335 (pstats
->rx_mimo_signalstrength
[rfpath
])) /
343 static void _rtl92se_update_rxsignalstatistics(struct ieee80211_hw
*hw
,
344 struct rtl_stats
*pstats
)
346 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
349 if (rtlpriv
->stats
.recv_signal_power
== 0)
350 rtlpriv
->stats
.recv_signal_power
= pstats
->recvsignalpower
;
352 if (pstats
->recvsignalpower
> rtlpriv
->stats
.recv_signal_power
)
354 else if (pstats
->recvsignalpower
< rtlpriv
->stats
.recv_signal_power
)
357 rtlpriv
->stats
.recv_signal_power
= (rtlpriv
->stats
.recv_signal_power
* 5
358 + pstats
->recvsignalpower
+
362 static void _rtl92se_process_pwdb(struct ieee80211_hw
*hw
,
363 struct rtl_stats
*pstats
)
365 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
366 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
367 long undec_sm_pwdb
= 0;
369 if (mac
->opmode
== NL80211_IFTYPE_ADHOC
) {
373 rtlpriv
->dm
.undecorated_smoothed_pwdb
;
376 if (pstats
->packet_toself
|| pstats
->packet_beacon
) {
377 if (undec_sm_pwdb
< 0)
378 undec_sm_pwdb
= pstats
->rx_pwdb_all
;
380 if (pstats
->rx_pwdb_all
> (u32
) undec_sm_pwdb
) {
383 (RX_SMOOTH_FACTOR
- 1)) +
384 (pstats
->rx_pwdb_all
)) / (RX_SMOOTH_FACTOR
);
386 undec_sm_pwdb
= undec_sm_pwdb
+ 1;
388 undec_sm_pwdb
= (((undec_sm_pwdb
) *
389 (RX_SMOOTH_FACTOR
- 1)) + (pstats
->rx_pwdb_all
)) /
393 rtlpriv
->dm
.undecorated_smoothed_pwdb
= undec_sm_pwdb
;
394 _rtl92se_update_rxsignalstatistics(hw
, pstats
);
398 static void rtl_92s_process_streams(struct ieee80211_hw
*hw
,
399 struct rtl_stats
*pstats
)
401 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
404 for (stream
= 0; stream
< 2; stream
++) {
405 if (pstats
->rx_mimo_signalquality
[stream
] != -1) {
406 if (rtlpriv
->stats
.rx_evm_percentage
[stream
] == 0) {
407 rtlpriv
->stats
.rx_evm_percentage
[stream
] =
408 pstats
->rx_mimo_signalquality
[stream
];
411 rtlpriv
->stats
.rx_evm_percentage
[stream
] =
412 ((rtlpriv
->stats
.rx_evm_percentage
[stream
] *
413 (RX_SMOOTH_FACTOR
- 1)) +
414 (pstats
->rx_mimo_signalquality
[stream
] *
415 1)) / (RX_SMOOTH_FACTOR
);
420 static void _rtl92se_process_ui_link_quality(struct ieee80211_hw
*hw
,
421 struct rtl_stats
*pstats
)
423 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
424 u32 last_evm
= 0, tmpval
;
426 if (pstats
->signalquality
!= 0) {
427 if (pstats
->packet_toself
|| pstats
->packet_beacon
) {
429 if (rtlpriv
->stats
.ui_link_quality
.total_num
++ >=
430 PHY_LINKQUALITY_SLID_WIN_MAX
) {
431 rtlpriv
->stats
.ui_link_quality
.total_num
=
432 PHY_LINKQUALITY_SLID_WIN_MAX
;
434 rtlpriv
->stats
.ui_link_quality
.elements
[
435 rtlpriv
->stats
.ui_link_quality
.index
];
436 rtlpriv
->stats
.ui_link_quality
.total_val
-=
440 rtlpriv
->stats
.ui_link_quality
.total_val
+=
441 pstats
->signalquality
;
442 rtlpriv
->stats
.ui_link_quality
.elements
[
443 rtlpriv
->stats
.ui_link_quality
.index
++] =
444 pstats
->signalquality
;
446 if (rtlpriv
->stats
.ui_link_quality
.index
>=
447 PHY_LINKQUALITY_SLID_WIN_MAX
)
448 rtlpriv
->stats
.ui_link_quality
.index
= 0;
450 tmpval
= rtlpriv
->stats
.ui_link_quality
.total_val
/
451 rtlpriv
->stats
.ui_link_quality
.total_num
;
452 rtlpriv
->stats
.signal_quality
= tmpval
;
454 rtlpriv
->stats
.last_sigstrength_inpercent
= tmpval
;
456 rtl_92s_process_streams(hw
, pstats
);
462 static void _rtl92se_process_phyinfo(struct ieee80211_hw
*hw
,
464 struct rtl_stats
*pcurrent_stats
)
467 if (!pcurrent_stats
->packet_matchbssid
&&
468 !pcurrent_stats
->packet_beacon
)
471 _rtl92se_process_ui_rssi(hw
, pcurrent_stats
);
472 _rtl92se_process_pwdb(hw
, pcurrent_stats
);
473 _rtl92se_process_ui_link_quality(hw
, pcurrent_stats
);
476 static void _rtl92se_translate_rx_signal_stuff(struct ieee80211_hw
*hw
,
477 struct sk_buff
*skb
, struct rtl_stats
*pstats
,
478 u8
*pdesc
, struct rx_fwinfo
*p_drvinfo
)
480 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
481 struct rtl_efuse
*rtlefuse
= rtl_efuse(rtl_priv(hw
));
483 struct ieee80211_hdr
*hdr
;
488 bool packet_matchbssid
, packet_toself
, packet_beacon
;
490 tmp_buf
= skb
->data
+ pstats
->rx_drvinfo_size
+ pstats
->rx_bufshift
;
492 hdr
= (struct ieee80211_hdr
*)tmp_buf
;
493 fc
= hdr
->frame_control
;
494 cfc
= le16_to_cpu(fc
);
495 type
= WLAN_FC_GET_TYPE(fc
);
498 packet_matchbssid
= ((IEEE80211_FTYPE_CTL
!= type
) &&
499 (!compare_ether_addr(mac
->bssid
, (cfc
& IEEE80211_FCTL_TODS
) ?
500 hdr
->addr1
: (cfc
& IEEE80211_FCTL_FROMDS
) ?
501 hdr
->addr2
: hdr
->addr3
)) && (!pstats
->hwerror
) &&
502 (!pstats
->crc
) && (!pstats
->icv
));
504 packet_toself
= packet_matchbssid
&&
505 (!compare_ether_addr(praddr
, rtlefuse
->dev_addr
));
507 if (ieee80211_is_beacon(fc
))
508 packet_beacon
= true;
510 _rtl92se_query_rxphystatus(hw
, pstats
, pdesc
, p_drvinfo
,
511 packet_matchbssid
, packet_toself
, packet_beacon
);
512 _rtl92se_process_phyinfo(hw
, tmp_buf
, pstats
);
515 bool rtl92se_rx_query_desc(struct ieee80211_hw
*hw
, struct rtl_stats
*stats
,
516 struct ieee80211_rx_status
*rx_status
, u8
*pdesc
,
519 struct rx_fwinfo
*p_drvinfo
;
520 u32 phystatus
= (u32
)GET_RX_STATUS_DESC_PHY_STATUS(pdesc
);
522 stats
->length
= (u16
)GET_RX_STATUS_DESC_PKT_LEN(pdesc
);
523 stats
->rx_drvinfo_size
= (u8
)GET_RX_STATUS_DESC_DRVINFO_SIZE(pdesc
) * 8;
524 stats
->rx_bufshift
= (u8
)(GET_RX_STATUS_DESC_SHIFT(pdesc
) & 0x03);
525 stats
->icv
= (u16
)GET_RX_STATUS_DESC_ICV(pdesc
);
526 stats
->crc
= (u16
)GET_RX_STATUS_DESC_CRC32(pdesc
);
527 stats
->hwerror
= (u16
)(stats
->crc
| stats
->icv
);
528 stats
->decrypted
= !GET_RX_STATUS_DESC_SWDEC(pdesc
);
530 stats
->rate
= (u8
)GET_RX_STATUS_DESC_RX_MCS(pdesc
);
531 stats
->shortpreamble
= (u16
)GET_RX_STATUS_DESC_SPLCP(pdesc
);
532 stats
->isampdu
= (bool)(GET_RX_STATUS_DESC_PAGGR(pdesc
) == 1);
533 stats
->timestamp_low
= GET_RX_STATUS_DESC_TSFL(pdesc
);
534 stats
->rx_is40Mhzpacket
= (bool)GET_RX_STATUS_DESC_BW(pdesc
);
539 rx_status
->freq
= hw
->conf
.channel
->center_freq
;
540 rx_status
->band
= hw
->conf
.channel
->band
;
542 if (GET_RX_STATUS_DESC_CRC32(pdesc
))
543 rx_status
->flag
|= RX_FLAG_FAILED_FCS_CRC
;
545 if (!GET_RX_STATUS_DESC_SWDEC(pdesc
))
546 rx_status
->flag
|= RX_FLAG_DECRYPTED
;
548 if (GET_RX_STATUS_DESC_BW(pdesc
))
549 rx_status
->flag
|= RX_FLAG_40MHZ
;
551 if (GET_RX_STATUS_DESC_RX_HT(pdesc
))
552 rx_status
->flag
|= RX_FLAG_HT
;
554 rx_status
->flag
|= RX_FLAG_MACTIME_MPDU
;
556 if (stats
->decrypted
)
557 rx_status
->flag
|= RX_FLAG_DECRYPTED
;
559 rx_status
->rate_idx
= rtlwifi_rate_mapping(hw
,
560 (bool)GET_RX_STATUS_DESC_RX_HT(pdesc
),
561 (u8
)GET_RX_STATUS_DESC_RX_MCS(pdesc
),
562 (bool)GET_RX_STATUS_DESC_PAGGR(pdesc
));
565 rx_status
->mactime
= GET_RX_STATUS_DESC_TSFL(pdesc
);
567 p_drvinfo
= (struct rx_fwinfo
*)(skb
->data
+
569 _rtl92se_translate_rx_signal_stuff(hw
, skb
, stats
, pdesc
,
573 /*rx_status->qual = stats->signal; */
574 rx_status
->signal
= stats
->rssi
+ 10;
575 /*rx_status->noise = -stats->noise; */
580 void rtl92se_tx_fill_desc(struct ieee80211_hw
*hw
,
581 struct ieee80211_hdr
*hdr
, u8
*pdesc_tx
,
582 struct ieee80211_tx_info
*info
, struct sk_buff
*skb
,
583 u8 hw_queue
, struct rtl_tcb_desc
*ptcb_desc
)
585 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
586 struct rtl_mac
*mac
= rtl_mac(rtl_priv(hw
));
587 struct rtl_pci
*rtlpci
= rtl_pcidev(rtl_pcipriv(hw
));
588 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
589 struct ieee80211_sta
*sta
= info
->control
.sta
;
590 u8
*pdesc
= (u8
*) pdesc_tx
;
592 __le16 fc
= hdr
->frame_control
;
593 u8 reserved_macid
= 0;
594 u8 fw_qsel
= _rtl92se_map_hwqueue_to_fwqueue(skb
, hw_queue
);
595 bool firstseg
= (!(hdr
->seq_ctrl
& cpu_to_le16(IEEE80211_SCTL_FRAG
)));
596 bool lastseg
= (!(hdr
->frame_control
&
597 cpu_to_le16(IEEE80211_FCTL_MOREFRAGS
)));
598 dma_addr_t mapping
= pci_map_single(rtlpci
->pdev
, skb
->data
, skb
->len
,
602 if (mac
->opmode
== NL80211_IFTYPE_STATION
) {
604 } else if (mac
->opmode
== NL80211_IFTYPE_AP
||
605 mac
->opmode
== NL80211_IFTYPE_ADHOC
) {
607 bw_40
= sta
->ht_cap
.cap
&
608 IEEE80211_HT_CAP_SUP_WIDTH_20_40
;
611 seq_number
= (le16_to_cpu(hdr
->seq_ctrl
) & IEEE80211_SCTL_SEQ
) >> 4;
613 rtl_get_tcb_desc(hw
, info
, sta
, skb
, ptcb_desc
);
615 CLEAR_PCI_TX_DESC_CONTENT(pdesc
, TX_DESC_SIZE_RTL8192S
);
618 if (rtlpriv
->dm
.useramask
) {
619 /* set txdesc macId */
620 if (ptcb_desc
->mac_id
< 32) {
621 SET_TX_DESC_MACID(pdesc
, ptcb_desc
->mac_id
);
622 reserved_macid
|= ptcb_desc
->mac_id
;
625 SET_TX_DESC_RSVD_MACID(pdesc
, reserved_macid
);
627 SET_TX_DESC_TXHT(pdesc
, ((ptcb_desc
->hw_rate
>=
628 DESC92_RATEMCS0
) ? 1 : 0));
630 if (rtlhal
->version
== VERSION_8192S_ACUT
) {
631 if (ptcb_desc
->hw_rate
== DESC92_RATE1M
||
632 ptcb_desc
->hw_rate
== DESC92_RATE2M
||
633 ptcb_desc
->hw_rate
== DESC92_RATE5_5M
||
634 ptcb_desc
->hw_rate
== DESC92_RATE11M
) {
635 ptcb_desc
->hw_rate
= DESC92_RATE12M
;
639 SET_TX_DESC_TX_RATE(pdesc
, ptcb_desc
->hw_rate
);
641 if (ptcb_desc
->use_shortgi
|| ptcb_desc
->use_shortpreamble
)
642 SET_TX_DESC_TX_SHORT(pdesc
, 0);
644 /* Aggregation related */
645 if (info
->flags
& IEEE80211_TX_CTL_AMPDU
)
646 SET_TX_DESC_AGG_ENABLE(pdesc
, 1);
648 /* For AMPDU, we must insert SSN into TX_DESC */
649 SET_TX_DESC_SEQ(pdesc
, seq_number
);
651 /* Protection mode related */
652 /* For 92S, if RTS/CTS are set, HW will execute RTS. */
653 /* We choose only one protection mode to execute */
654 SET_TX_DESC_RTS_ENABLE(pdesc
, ((ptcb_desc
->rts_enable
&&
655 !ptcb_desc
->cts_enable
) ? 1 : 0));
656 SET_TX_DESC_CTS_ENABLE(pdesc
, ((ptcb_desc
->cts_enable
) ?
658 SET_TX_DESC_RTS_STBC(pdesc
, ((ptcb_desc
->rts_stbc
) ? 1 : 0));
660 SET_TX_DESC_RTS_RATE(pdesc
, ptcb_desc
->rts_rate
);
661 SET_TX_DESC_RTS_BANDWIDTH(pdesc
, 0);
662 SET_TX_DESC_RTS_SUB_CARRIER(pdesc
, ptcb_desc
->rts_sc
);
663 SET_TX_DESC_RTS_SHORT(pdesc
, ((ptcb_desc
->rts_rate
<=
665 (ptcb_desc
->rts_use_shortpreamble
? 1 : 0)
666 : (ptcb_desc
->rts_use_shortgi
? 1 : 0)));
669 /* Set Bandwidth and sub-channel settings. */
671 if (ptcb_desc
->packet_bw
) {
672 SET_TX_DESC_TX_BANDWIDTH(pdesc
, 1);
673 /* use duplicated mode */
674 SET_TX_DESC_TX_SUB_CARRIER(pdesc
, 0);
676 SET_TX_DESC_TX_BANDWIDTH(pdesc
, 0);
677 SET_TX_DESC_TX_SUB_CARRIER(pdesc
,
678 mac
->cur_40_prime_sc
);
681 SET_TX_DESC_TX_BANDWIDTH(pdesc
, 0);
682 SET_TX_DESC_TX_SUB_CARRIER(pdesc
, 0);
685 /* 3 Fill necessary field in First Descriptor */
687 SET_TX_DESC_LINIP(pdesc
, 0);
688 SET_TX_DESC_OFFSET(pdesc
, 32);
689 SET_TX_DESC_PKT_SIZE(pdesc
, (u16
) skb
->len
);
692 SET_TX_DESC_RA_BRSR_ID(pdesc
, ptcb_desc
->ratr_index
);
694 /* Fill security related */
695 if (info
->control
.hw_key
) {
696 struct ieee80211_key_conf
*keyconf
;
698 keyconf
= info
->control
.hw_key
;
699 switch (keyconf
->cipher
) {
700 case WLAN_CIPHER_SUITE_WEP40
:
701 case WLAN_CIPHER_SUITE_WEP104
:
702 SET_TX_DESC_SEC_TYPE(pdesc
, 0x1);
704 case WLAN_CIPHER_SUITE_TKIP
:
705 SET_TX_DESC_SEC_TYPE(pdesc
, 0x2);
707 case WLAN_CIPHER_SUITE_CCMP
:
708 SET_TX_DESC_SEC_TYPE(pdesc
, 0x3);
711 SET_TX_DESC_SEC_TYPE(pdesc
, 0x0);
718 SET_TX_DESC_PACKET_ID(pdesc
, 0);
720 /* We will assign magement queue to BK. */
721 SET_TX_DESC_QUEUE_SEL(pdesc
, fw_qsel
);
723 /* Alwasy enable all rate fallback range */
724 SET_TX_DESC_DATA_RATE_FB_LIMIT(pdesc
, 0x1F);
726 /* Fix: I don't kown why hw use 6.5M to tx when set it */
727 SET_TX_DESC_USER_RATE(pdesc
,
728 ptcb_desc
->use_driver_rate
? 1 : 0);
730 /* Set NON_QOS bit. */
731 if (!ieee80211_is_data_qos(fc
))
732 SET_TX_DESC_NON_QOS(pdesc
, 1);
736 /* Fill fields that are required to be initialized
737 * in all of the descriptors */
739 SET_TX_DESC_FIRST_SEG(pdesc
, (firstseg
? 1 : 0));
740 SET_TX_DESC_LAST_SEG(pdesc
, (lastseg
? 1 : 0));
743 SET_TX_DESC_TX_BUFFER_SIZE(pdesc
, (u16
) skb
->len
);
746 SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc
, cpu_to_le32(mapping
));
748 RT_TRACE(rtlpriv
, COMP_SEND
, DBG_TRACE
, ("\n"));
751 void rtl92se_tx_fill_cmddesc(struct ieee80211_hw
*hw
, u8
*pdesc
,
752 bool firstseg
, bool lastseg
, struct sk_buff
*skb
)
754 struct rtl_pci
*rtlpci
= rtl_pcidev(rtl_pcipriv(hw
));
755 struct rtl_hal
*rtlhal
= rtl_hal(rtl_priv(hw
));
756 struct rtl_tcb_desc
*tcb_desc
= (struct rtl_tcb_desc
*)(skb
->cb
);
758 dma_addr_t mapping
= pci_map_single(rtlpci
->pdev
, skb
->data
, skb
->len
,
761 /* Clear all status */
762 CLEAR_PCI_TX_DESC_CONTENT(pdesc
, TX_CMDDESC_SIZE_RTL8192S
);
764 /* This bit indicate this packet is used for FW download. */
765 if (tcb_desc
->cmd_or_init
== DESC_PACKET_TYPE_INIT
) {
766 /* For firmware downlaod we only need to set LINIP */
767 SET_TX_DESC_LINIP(pdesc
, tcb_desc
->last_inipkt
);
769 /* 92SE must set as 1 for firmware download HW DMA error */
770 SET_TX_DESC_FIRST_SEG(pdesc
, 1);
771 SET_TX_DESC_LAST_SEG(pdesc
, 1);
773 /* 92SE need not to set TX packet size when firmware download */
774 SET_TX_DESC_PKT_SIZE(pdesc
, (u16
)(skb
->len
));
775 SET_TX_DESC_TX_BUFFER_SIZE(pdesc
, (u16
)(skb
->len
));
776 SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc
, cpu_to_le32(mapping
));
779 SET_TX_DESC_OWN(pdesc
, 1);
780 } else { /* H2C Command Desc format (Host TXCMD) */
781 /* 92SE must set as 1 for firmware download HW DMA error */
782 SET_TX_DESC_FIRST_SEG(pdesc
, 1);
783 SET_TX_DESC_LAST_SEG(pdesc
, 1);
785 SET_TX_DESC_OFFSET(pdesc
, 0x20);
787 /* Buffer size + command header */
788 SET_TX_DESC_PKT_SIZE(pdesc
, (u16
)(skb
->len
));
789 /* Fixed queue of H2C command */
790 SET_TX_DESC_QUEUE_SEL(pdesc
, 0x13);
792 SET_BITS_TO_LE_4BYTE(skb
->data
, 24, 7, rtlhal
->h2c_txcmd_seq
);
794 SET_TX_DESC_TX_BUFFER_SIZE(pdesc
, (u16
)(skb
->len
));
795 SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc
, cpu_to_le32(mapping
));
798 SET_TX_DESC_OWN(pdesc
, 1);
803 void rtl92se_set_desc(u8
*pdesc
, bool istx
, u8 desc_name
, u8
*val
)
809 SET_TX_DESC_OWN(pdesc
, 1);
811 case HW_DESC_TX_NEXTDESC_ADDR
:
812 SET_TX_DESC_NEXT_DESC_ADDRESS(pdesc
, *(u32
*) val
);
815 RT_ASSERT(false, ("ERR txdesc :%d not process\n",
823 SET_RX_STATUS_DESC_OWN(pdesc
, 1);
825 case HW_DESC_RXBUFF_ADDR
:
826 SET_RX_STATUS__DESC_BUFF_ADDR(pdesc
, *(u32
*) val
);
828 case HW_DESC_RXPKT_LEN
:
829 SET_RX_STATUS_DESC_PKT_LEN(pdesc
, *(u32
*) val
);
832 SET_RX_STATUS_DESC_EOR(pdesc
, 1);
835 RT_ASSERT(false, ("ERR rxdesc :%d not process\n",
842 u32
rtl92se_get_desc(u8
*desc
, bool istx
, u8 desc_name
)
849 ret
= GET_TX_DESC_OWN(desc
);
851 case HW_DESC_TXBUFF_ADDR
:
852 ret
= GET_TX_DESC_TX_BUFFER_ADDRESS(desc
);
855 RT_ASSERT(false, ("ERR txdesc :%d not process\n",
862 ret
= GET_RX_STATUS_DESC_OWN(desc
);
864 case HW_DESC_RXPKT_LEN
:
865 ret
= GET_RX_STATUS_DESC_PKT_LEN(desc
);
868 RT_ASSERT(false, ("ERR rxdesc :%d not process\n",
876 void rtl92se_tx_polling(struct ieee80211_hw
*hw
, u8 hw_queue
)
878 struct rtl_priv
*rtlpriv
= rtl_priv(hw
);
879 rtl_write_word(rtlpriv
, TP_POLL
, BIT(0) << (hw_queue
));