trx.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2009-2012 Realtek Corporation.
  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. #include "../wifi.h"
  30. #include "../pci.h"
  31. #include "../base.h"
  32. #include "../stats.h"
  33. #include "reg.h"
  34. #include "def.h"
  35. #include "phy.h"
  36. #include "fw.h"
  37. #include "trx.h"
  38. #include "led.h"
  39. static u8 _rtl92se_map_hwqueue_to_fwqueue(struct sk_buff *skb, u8 skb_queue)
  40. {
  41. __le16 fc = rtl_get_fc(skb);
  42. if (unlikely(ieee80211_is_beacon(fc)))
  43. return QSLT_BEACON;
  44. if (ieee80211_is_mgmt(fc) || ieee80211_is_ctl(fc))
  45. return QSLT_MGNT;
  46. if (ieee80211_is_nullfunc(fc))
  47. return QSLT_HIGH;
  48. return skb->priority;
  49. }
  50. static void _rtl92se_query_rxphystatus(struct ieee80211_hw *hw,
  51. struct rtl_stats *pstats, u8 *pdesc,
  52. struct rx_fwinfo *p_drvinfo,
  53. bool packet_match_bssid,
  54. bool packet_toself,
  55. bool packet_beacon)
  56. {
  57. struct rtl_priv *rtlpriv = rtl_priv(hw);
  58. struct phy_sts_cck_8192s_t *cck_buf;
  59. struct rtl_ps_ctl *ppsc = rtl_psc(rtlpriv);
  60. s8 rx_pwr_all = 0, rx_pwr[4];
  61. u8 rf_rx_num = 0, evm, pwdb_all;
  62. u8 i, max_spatial_stream;
  63. u32 rssi, total_rssi = 0;
  64. bool is_cck = pstats->is_cck;
  65. pstats->packet_matchbssid = packet_match_bssid;
  66. pstats->packet_toself = packet_toself;
  67. pstats->packet_beacon = packet_beacon;
  68. pstats->rx_mimo_sig_qual[0] = -1;
  69. pstats->rx_mimo_sig_qual[1] = -1;
  70. if (is_cck) {
  71. u8 report, cck_highpwr;
  72. cck_buf = (struct phy_sts_cck_8192s_t *)p_drvinfo;
  73. if (ppsc->rfpwr_state == ERFON)
  74. cck_highpwr = (u8) rtl_get_bbreg(hw,
  75. RFPGA0_XA_HSSIPARAMETER2,
  76. 0x200);
  77. else
  78. cck_highpwr = false;
  79. if (!cck_highpwr) {
  80. u8 cck_agc_rpt = cck_buf->cck_agc_rpt;
  81. report = cck_buf->cck_agc_rpt & 0xc0;
  82. report = report >> 6;
  83. switch (report) {
  84. case 0x3:
  85. rx_pwr_all = -40 - (cck_agc_rpt & 0x3e);
  86. break;
  87. case 0x2:
  88. rx_pwr_all = -20 - (cck_agc_rpt & 0x3e);
  89. break;
  90. case 0x1:
  91. rx_pwr_all = -2 - (cck_agc_rpt & 0x3e);
  92. break;
  93. case 0x0:
  94. rx_pwr_all = 14 - (cck_agc_rpt & 0x3e);
  95. break;
  96. }
  97. } else {
  98. u8 cck_agc_rpt = cck_buf->cck_agc_rpt;
  99. report = p_drvinfo->cfosho[0] & 0x60;
  100. report = report >> 5;
  101. switch (report) {
  102. case 0x3:
  103. rx_pwr_all = -40 - ((cck_agc_rpt & 0x1f) << 1);
  104. break;
  105. case 0x2:
  106. rx_pwr_all = -20 - ((cck_agc_rpt & 0x1f) << 1);
  107. break;
  108. case 0x1:
  109. rx_pwr_all = -2 - ((cck_agc_rpt & 0x1f) << 1);
  110. break;
  111. case 0x0:
  112. rx_pwr_all = 14 - ((cck_agc_rpt & 0x1f) << 1);
  113. break;
  114. }
  115. }
  116. pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all);
  117. /* CCK gain is smaller than OFDM/MCS gain, */
  118. /* so we add gain diff by experiences, the val is 6 */
  119. pwdb_all += 6;
  120. if (pwdb_all > 100)
  121. pwdb_all = 100;
  122. /* modify the offset to make the same gain index with OFDM. */
  123. if (pwdb_all > 34 && pwdb_all <= 42)
  124. pwdb_all -= 2;
  125. else if (pwdb_all > 26 && pwdb_all <= 34)
  126. pwdb_all -= 6;
  127. else if (pwdb_all > 14 && pwdb_all <= 26)
  128. pwdb_all -= 8;
  129. else if (pwdb_all > 4 && pwdb_all <= 14)
  130. pwdb_all -= 4;
  131. pstats->rx_pwdb_all = pwdb_all;
  132. pstats->recvsignalpower = rx_pwr_all;
  133. if (packet_match_bssid) {
  134. u8 sq;
  135. if (pstats->rx_pwdb_all > 40) {
  136. sq = 100;
  137. } else {
  138. sq = cck_buf->sq_rpt;
  139. if (sq > 64)
  140. sq = 0;
  141. else if (sq < 20)
  142. sq = 100;
  143. else
  144. sq = ((64 - sq) * 100) / 44;
  145. }
  146. pstats->signalquality = sq;
  147. pstats->rx_mimo_sig_qual[0] = sq;
  148. pstats->rx_mimo_sig_qual[1] = -1;
  149. }
  150. } else {
  151. rtlpriv->dm.rfpath_rxenable[0] =
  152. rtlpriv->dm.rfpath_rxenable[1] = true;
  153. for (i = RF90_PATH_A; i < RF6052_MAX_PATH; i++) {
  154. if (rtlpriv->dm.rfpath_rxenable[i])
  155. rf_rx_num++;
  156. rx_pwr[i] = ((p_drvinfo->gain_trsw[i] &
  157. 0x3f) * 2) - 110;
  158. rssi = rtl_query_rxpwrpercentage(rx_pwr[i]);
  159. total_rssi += rssi;
  160. rtlpriv->stats.rx_snr_db[i] =
  161. (long)(p_drvinfo->rxsnr[i] / 2);
  162. if (packet_match_bssid)
  163. pstats->rx_mimo_signalstrength[i] = (u8) rssi;
  164. }
  165. rx_pwr_all = ((p_drvinfo->pwdb_all >> 1) & 0x7f) - 110;
  166. pwdb_all = rtl_query_rxpwrpercentage(rx_pwr_all);
  167. pstats->rx_pwdb_all = pwdb_all;
  168. pstats->rxpower = rx_pwr_all;
  169. pstats->recvsignalpower = rx_pwr_all;
  170. if (pstats->is_ht && pstats->rate >= DESC92_RATEMCS8 &&
  171. pstats->rate <= DESC92_RATEMCS15)
  172. max_spatial_stream = 2;
  173. else
  174. max_spatial_stream = 1;
  175. for (i = 0; i < max_spatial_stream; i++) {
  176. evm = rtl_evm_db_to_percentage(p_drvinfo->rxevm[i]);
  177. if (packet_match_bssid) {
  178. if (i == 0)
  179. pstats->signalquality = (u8)(evm &
  180. 0xff);
  181. pstats->rx_mimo_sig_qual[i] = (u8) (evm & 0xff);
  182. }
  183. }
  184. }
  185. if (is_cck)
  186. pstats->signalstrength = (u8)(rtl_signal_scale_mapping(hw,
  187. pwdb_all));
  188. else if (rf_rx_num != 0)
  189. pstats->signalstrength = (u8) (rtl_signal_scale_mapping(hw,
  190. total_rssi /= rf_rx_num));
  191. }
  192. static void _rtl92se_translate_rx_signal_stuff(struct ieee80211_hw *hw,
  193. struct sk_buff *skb, struct rtl_stats *pstats,
  194. u8 *pdesc, struct rx_fwinfo *p_drvinfo)
  195. {
  196. struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  197. struct rtl_efuse *rtlefuse = rtl_efuse(rtl_priv(hw));
  198. struct ieee80211_hdr *hdr;
  199. u8 *tmp_buf;
  200. u8 *praddr;
  201. __le16 fc;
  202. u16 type, cfc;
  203. bool packet_matchbssid, packet_toself, packet_beacon = false;
  204. tmp_buf = skb->data + pstats->rx_drvinfo_size + pstats->rx_bufshift;
  205. hdr = (struct ieee80211_hdr *)tmp_buf;
  206. fc = hdr->frame_control;
  207. cfc = le16_to_cpu(fc);
  208. type = WLAN_FC_GET_TYPE(fc);
  209. praddr = hdr->addr1;
  210. packet_matchbssid = ((IEEE80211_FTYPE_CTL != type) &&
  211. ether_addr_equal(mac->bssid,
  212. (cfc & IEEE80211_FCTL_TODS) ? hdr->addr1 :
  213. (cfc & IEEE80211_FCTL_FROMDS) ? hdr->addr2 :
  214. hdr->addr3) &&
  215. (!pstats->hwerror) && (!pstats->crc) && (!pstats->icv));
  216. packet_toself = packet_matchbssid &&
  217. ether_addr_equal(praddr, rtlefuse->dev_addr);
  218. if (ieee80211_is_beacon(fc))
  219. packet_beacon = true;
  220. _rtl92se_query_rxphystatus(hw, pstats, pdesc, p_drvinfo,
  221. packet_matchbssid, packet_toself, packet_beacon);
  222. rtl_process_phyinfo(hw, tmp_buf, pstats);
  223. }
  224. bool rtl92se_rx_query_desc(struct ieee80211_hw *hw, struct rtl_stats *stats,
  225. struct ieee80211_rx_status *rx_status, u8 *pdesc,
  226. struct sk_buff *skb)
  227. {
  228. struct rx_fwinfo *p_drvinfo;
  229. u32 phystatus = (u32)GET_RX_STATUS_DESC_PHY_STATUS(pdesc);
  230. struct ieee80211_hdr *hdr;
  231. bool first_ampdu = false;
  232. stats->length = (u16)GET_RX_STATUS_DESC_PKT_LEN(pdesc);
  233. stats->rx_drvinfo_size = (u8)GET_RX_STATUS_DESC_DRVINFO_SIZE(pdesc) * 8;
  234. stats->rx_bufshift = (u8)(GET_RX_STATUS_DESC_SHIFT(pdesc) & 0x03);
  235. stats->icv = (u16)GET_RX_STATUS_DESC_ICV(pdesc);
  236. stats->crc = (u16)GET_RX_STATUS_DESC_CRC32(pdesc);
  237. stats->hwerror = (u16)(stats->crc | stats->icv);
  238. stats->decrypted = !GET_RX_STATUS_DESC_SWDEC(pdesc);
  239. stats->rate = (u8)GET_RX_STATUS_DESC_RX_MCS(pdesc);
  240. stats->shortpreamble = (u16)GET_RX_STATUS_DESC_SPLCP(pdesc);
  241. stats->isampdu = (bool)(GET_RX_STATUS_DESC_PAGGR(pdesc) == 1);
  242. stats->isfirst_ampdu = (bool) ((GET_RX_STATUS_DESC_PAGGR(pdesc) == 1)
  243. && (GET_RX_STATUS_DESC_FAGGR(pdesc) == 1));
  244. stats->timestamp_low = GET_RX_STATUS_DESC_TSFL(pdesc);
  245. stats->rx_is40Mhzpacket = (bool)GET_RX_STATUS_DESC_BW(pdesc);
  246. stats->is_ht = (bool)GET_RX_STATUS_DESC_RX_HT(pdesc);
  247. stats->is_cck = SE_RX_HAL_IS_CCK_RATE(pdesc);
  248. if (stats->hwerror)
  249. return false;
  250. rx_status->freq = hw->conf.chandef.chan->center_freq;
  251. rx_status->band = hw->conf.chandef.chan->band;
  252. if (stats->crc)
  253. rx_status->flag |= RX_FLAG_FAILED_FCS_CRC;
  254. if (stats->rx_is40Mhzpacket)
  255. rx_status->flag |= RX_FLAG_40MHZ;
  256. if (stats->is_ht)
  257. rx_status->flag |= RX_FLAG_HT;
  258. rx_status->flag |= RX_FLAG_MACTIME_START;
  259. /* hw will set stats->decrypted true, if it finds the
  260. * frame is open data frame or mgmt frame,
  261. * hw will not decrypt robust managment frame
  262. * for IEEE80211w but still set stats->decrypted
  263. * true, so here we should set it back to undecrypted
  264. * for IEEE80211w frame, and mac80211 sw will help
  265. * to decrypt it */
  266. if (stats->decrypted) {
  267. hdr = (struct ieee80211_hdr *)(skb->data +
  268. stats->rx_drvinfo_size + stats->rx_bufshift);
  269. if (!hdr) {
  270. /* during testing, hdr was NULL here */
  271. return false;
  272. }
  273. if ((ieee80211_is_robust_mgmt_frame(hdr)) &&
  274. (ieee80211_has_protected(hdr->frame_control)))
  275. rx_status->flag &= ~RX_FLAG_DECRYPTED;
  276. else
  277. rx_status->flag |= RX_FLAG_DECRYPTED;
  278. }
  279. rx_status->rate_idx = rtlwifi_rate_mapping(hw,
  280. stats->is_ht, stats->rate, first_ampdu);
  281. rx_status->mactime = stats->timestamp_low;
  282. if (phystatus) {
  283. p_drvinfo = (struct rx_fwinfo *)(skb->data +
  284. stats->rx_bufshift);
  285. _rtl92se_translate_rx_signal_stuff(hw, skb, stats, pdesc,
  286. p_drvinfo);
  287. }
  288. /*rx_status->qual = stats->signal; */
  289. rx_status->signal = stats->rssi + 10;
  290. /*rx_status->noise = -stats->noise; */
  291. return true;
  292. }
  293. void rtl92se_tx_fill_desc(struct ieee80211_hw *hw,
  294. struct ieee80211_hdr *hdr, u8 *pdesc_tx,
  295. struct ieee80211_tx_info *info,
  296. struct ieee80211_sta *sta,
  297. struct sk_buff *skb,
  298. u8 hw_queue, struct rtl_tcb_desc *ptcb_desc)
  299. {
  300. struct rtl_priv *rtlpriv = rtl_priv(hw);
  301. struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
  302. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  303. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  304. u8 *pdesc = pdesc_tx;
  305. u16 seq_number;
  306. __le16 fc = hdr->frame_control;
  307. u8 reserved_macid = 0;
  308. u8 fw_qsel = _rtl92se_map_hwqueue_to_fwqueue(skb, hw_queue);
  309. bool firstseg = (!(hdr->seq_ctrl & cpu_to_le16(IEEE80211_SCTL_FRAG)));
  310. bool lastseg = (!(hdr->frame_control &
  311. cpu_to_le16(IEEE80211_FCTL_MOREFRAGS)));
  312. dma_addr_t mapping = pci_map_single(rtlpci->pdev, skb->data, skb->len,
  313. PCI_DMA_TODEVICE);
  314. u8 bw_40 = 0;
  315. if (pci_dma_mapping_error(rtlpci->pdev, mapping)) {
  316. RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE,
  317. "DMA mapping error");
  318. return;
  319. }
  320. if (mac->opmode == NL80211_IFTYPE_STATION) {
  321. bw_40 = mac->bw_40;
  322. } else if (mac->opmode == NL80211_IFTYPE_AP ||
  323. mac->opmode == NL80211_IFTYPE_ADHOC) {
  324. if (sta)
  325. bw_40 = sta->bandwidth >= IEEE80211_STA_RX_BW_40;
  326. }
  327. seq_number = (le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_SEQ) >> 4;
  328. rtl_get_tcb_desc(hw, info, sta, skb, ptcb_desc);
  329. CLEAR_PCI_TX_DESC_CONTENT(pdesc, TX_DESC_SIZE_RTL8192S);
  330. if (ieee80211_is_nullfunc(fc) || ieee80211_is_ctl(fc)) {
  331. firstseg = true;
  332. lastseg = true;
  333. }
  334. if (firstseg) {
  335. if (rtlpriv->dm.useramask) {
  336. /* set txdesc macId */
  337. if (ptcb_desc->mac_id < 32) {
  338. SET_TX_DESC_MACID(pdesc, ptcb_desc->mac_id);
  339. reserved_macid |= ptcb_desc->mac_id;
  340. }
  341. }
  342. SET_TX_DESC_RSVD_MACID(pdesc, reserved_macid);
  343. SET_TX_DESC_TXHT(pdesc, ((ptcb_desc->hw_rate >=
  344. DESC92_RATEMCS0) ? 1 : 0));
  345. if (rtlhal->version == VERSION_8192S_ACUT) {
  346. if (ptcb_desc->hw_rate == DESC92_RATE1M ||
  347. ptcb_desc->hw_rate == DESC92_RATE2M ||
  348. ptcb_desc->hw_rate == DESC92_RATE5_5M ||
  349. ptcb_desc->hw_rate == DESC92_RATE11M) {
  350. ptcb_desc->hw_rate = DESC92_RATE12M;
  351. }
  352. }
  353. SET_TX_DESC_TX_RATE(pdesc, ptcb_desc->hw_rate);
  354. if (ptcb_desc->use_shortgi || ptcb_desc->use_shortpreamble)
  355. SET_TX_DESC_TX_SHORT(pdesc, 0);
  356. /* Aggregation related */
  357. if (info->flags & IEEE80211_TX_CTL_AMPDU)
  358. SET_TX_DESC_AGG_ENABLE(pdesc, 1);
  359. /* For AMPDU, we must insert SSN into TX_DESC */
  360. SET_TX_DESC_SEQ(pdesc, seq_number);
  361. /* Protection mode related */
  362. /* For 92S, if RTS/CTS are set, HW will execute RTS. */
  363. /* We choose only one protection mode to execute */
  364. SET_TX_DESC_RTS_ENABLE(pdesc, ((ptcb_desc->rts_enable &&
  365. !ptcb_desc->cts_enable) ? 1 : 0));
  366. SET_TX_DESC_CTS_ENABLE(pdesc, ((ptcb_desc->cts_enable) ?
  367. 1 : 0));
  368. SET_TX_DESC_RTS_STBC(pdesc, ((ptcb_desc->rts_stbc) ? 1 : 0));
  369. SET_TX_DESC_RTS_RATE(pdesc, ptcb_desc->rts_rate);
  370. SET_TX_DESC_RTS_BANDWIDTH(pdesc, 0);
  371. SET_TX_DESC_RTS_SUB_CARRIER(pdesc, ptcb_desc->rts_sc);
  372. SET_TX_DESC_RTS_SHORT(pdesc, ((ptcb_desc->rts_rate <=
  373. DESC92_RATE54M) ?
  374. (ptcb_desc->rts_use_shortpreamble ? 1 : 0)
  375. : (ptcb_desc->rts_use_shortgi ? 1 : 0)));
  376. /* Set Bandwidth and sub-channel settings. */
  377. if (bw_40) {
  378. if (ptcb_desc->packet_bw) {
  379. SET_TX_DESC_TX_BANDWIDTH(pdesc, 1);
  380. /* use duplicated mode */
  381. SET_TX_DESC_TX_SUB_CARRIER(pdesc, 0);
  382. } else {
  383. SET_TX_DESC_TX_BANDWIDTH(pdesc, 0);
  384. SET_TX_DESC_TX_SUB_CARRIER(pdesc,
  385. mac->cur_40_prime_sc);
  386. }
  387. } else {
  388. SET_TX_DESC_TX_BANDWIDTH(pdesc, 0);
  389. SET_TX_DESC_TX_SUB_CARRIER(pdesc, 0);
  390. }
  391. /* 3 Fill necessary field in First Descriptor */
  392. /*DWORD 0*/
  393. SET_TX_DESC_LINIP(pdesc, 0);
  394. SET_TX_DESC_OFFSET(pdesc, 32);
  395. SET_TX_DESC_PKT_SIZE(pdesc, (u16) skb->len);
  396. /*DWORD 1*/
  397. SET_TX_DESC_RA_BRSR_ID(pdesc, ptcb_desc->ratr_index);
  398. /* Fill security related */
  399. if (info->control.hw_key) {
  400. struct ieee80211_key_conf *keyconf;
  401. keyconf = info->control.hw_key;
  402. switch (keyconf->cipher) {
  403. case WLAN_CIPHER_SUITE_WEP40:
  404. case WLAN_CIPHER_SUITE_WEP104:
  405. SET_TX_DESC_SEC_TYPE(pdesc, 0x1);
  406. break;
  407. case WLAN_CIPHER_SUITE_TKIP:
  408. SET_TX_DESC_SEC_TYPE(pdesc, 0x2);
  409. break;
  410. case WLAN_CIPHER_SUITE_CCMP:
  411. SET_TX_DESC_SEC_TYPE(pdesc, 0x3);
  412. break;
  413. default:
  414. SET_TX_DESC_SEC_TYPE(pdesc, 0x0);
  415. break;
  416. }
  417. }
  418. /* Set Packet ID */
  419. SET_TX_DESC_PACKET_ID(pdesc, 0);
  420. /* We will assign magement queue to BK. */
  421. SET_TX_DESC_QUEUE_SEL(pdesc, fw_qsel);
  422. /* Alwasy enable all rate fallback range */
  423. SET_TX_DESC_DATA_RATE_FB_LIMIT(pdesc, 0x1F);
  424. /* Fix: I don't kown why hw use 6.5M to tx when set it */
  425. SET_TX_DESC_USER_RATE(pdesc,
  426. ptcb_desc->use_driver_rate ? 1 : 0);
  427. /* Set NON_QOS bit. */
  428. if (!ieee80211_is_data_qos(fc))
  429. SET_TX_DESC_NON_QOS(pdesc, 1);
  430. }
  431. /* Fill fields that are required to be initialized
  432. * in all of the descriptors */
  433. /*DWORD 0 */
  434. SET_TX_DESC_FIRST_SEG(pdesc, (firstseg ? 1 : 0));
  435. SET_TX_DESC_LAST_SEG(pdesc, (lastseg ? 1 : 0));
  436. /* DWORD 7 */
  437. SET_TX_DESC_TX_BUFFER_SIZE(pdesc, (u16) skb->len);
  438. /* DOWRD 8 */
  439. SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc, mapping);
  440. RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE, "\n");
  441. }
  442. void rtl92se_tx_fill_cmddesc(struct ieee80211_hw *hw, u8 *pdesc,
  443. bool firstseg, bool lastseg, struct sk_buff *skb)
  444. {
  445. struct rtl_priv *rtlpriv = rtl_priv(hw);
  446. struct rtl_pci *rtlpci = rtl_pcidev(rtl_pcipriv(hw));
  447. struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  448. struct rtl_tcb_desc *tcb_desc = (struct rtl_tcb_desc *)(skb->cb);
  449. dma_addr_t mapping = pci_map_single(rtlpci->pdev, skb->data, skb->len,
  450. PCI_DMA_TODEVICE);
  451. if (pci_dma_mapping_error(rtlpci->pdev, mapping)) {
  452. RT_TRACE(rtlpriv, COMP_SEND, DBG_TRACE,
  453. "DMA mapping error");
  454. return;
  455. }
  456. /* Clear all status */
  457. CLEAR_PCI_TX_DESC_CONTENT(pdesc, TX_CMDDESC_SIZE_RTL8192S);
  458. /* This bit indicate this packet is used for FW download. */
  459. if (tcb_desc->cmd_or_init == DESC_PACKET_TYPE_INIT) {
  460. /* For firmware downlaod we only need to set LINIP */
  461. SET_TX_DESC_LINIP(pdesc, tcb_desc->last_inipkt);
  462. /* 92SE must set as 1 for firmware download HW DMA error */
  463. SET_TX_DESC_FIRST_SEG(pdesc, 1);
  464. SET_TX_DESC_LAST_SEG(pdesc, 1);
  465. /* 92SE need not to set TX packet size when firmware download */
  466. SET_TX_DESC_PKT_SIZE(pdesc, (u16)(skb->len));
  467. SET_TX_DESC_TX_BUFFER_SIZE(pdesc, (u16)(skb->len));
  468. SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc, mapping);
  469. wmb();
  470. SET_TX_DESC_OWN(pdesc, 1);
  471. } else { /* H2C Command Desc format (Host TXCMD) */
  472. /* 92SE must set as 1 for firmware download HW DMA error */
  473. SET_TX_DESC_FIRST_SEG(pdesc, 1);
  474. SET_TX_DESC_LAST_SEG(pdesc, 1);
  475. SET_TX_DESC_OFFSET(pdesc, 0x20);
  476. /* Buffer size + command header */
  477. SET_TX_DESC_PKT_SIZE(pdesc, (u16)(skb->len));
  478. /* Fixed queue of H2C command */
  479. SET_TX_DESC_QUEUE_SEL(pdesc, 0x13);
  480. SET_BITS_TO_LE_4BYTE(skb->data, 24, 7, rtlhal->h2c_txcmd_seq);
  481. SET_TX_DESC_TX_BUFFER_SIZE(pdesc, (u16)(skb->len));
  482. SET_TX_DESC_TX_BUFFER_ADDRESS(pdesc, mapping);
  483. wmb();
  484. SET_TX_DESC_OWN(pdesc, 1);
  485. }
  486. }
  487. void rtl92se_set_desc(u8 *pdesc, bool istx, u8 desc_name, u8 *val)
  488. {
  489. if (istx) {
  490. switch (desc_name) {
  491. case HW_DESC_OWN:
  492. wmb();
  493. SET_TX_DESC_OWN(pdesc, 1);
  494. break;
  495. case HW_DESC_TX_NEXTDESC_ADDR:
  496. SET_TX_DESC_NEXT_DESC_ADDRESS(pdesc, *(u32 *) val);
  497. break;
  498. default:
  499. RT_ASSERT(false, "ERR txdesc :%d not process\n",
  500. desc_name);
  501. break;
  502. }
  503. } else {
  504. switch (desc_name) {
  505. case HW_DESC_RXOWN:
  506. wmb();
  507. SET_RX_STATUS_DESC_OWN(pdesc, 1);
  508. break;
  509. case HW_DESC_RXBUFF_ADDR:
  510. SET_RX_STATUS__DESC_BUFF_ADDR(pdesc, *(u32 *) val);
  511. break;
  512. case HW_DESC_RXPKT_LEN:
  513. SET_RX_STATUS_DESC_PKT_LEN(pdesc, *(u32 *) val);
  514. break;
  515. case HW_DESC_RXERO:
  516. SET_RX_STATUS_DESC_EOR(pdesc, 1);
  517. break;
  518. default:
  519. RT_ASSERT(false, "ERR rxdesc :%d not process\n",
  520. desc_name);
  521. break;
  522. }
  523. }
  524. }
  525. u32 rtl92se_get_desc(u8 *desc, bool istx, u8 desc_name)
  526. {
  527. u32 ret = 0;
  528. if (istx) {
  529. switch (desc_name) {
  530. case HW_DESC_OWN:
  531. ret = GET_TX_DESC_OWN(desc);
  532. break;
  533. case HW_DESC_TXBUFF_ADDR:
  534. ret = GET_TX_DESC_TX_BUFFER_ADDRESS(desc);
  535. break;
  536. default:
  537. RT_ASSERT(false, "ERR txdesc :%d not process\n",
  538. desc_name);
  539. break;
  540. }
  541. } else {
  542. switch (desc_name) {
  543. case HW_DESC_OWN:
  544. ret = GET_RX_STATUS_DESC_OWN(desc);
  545. break;
  546. case HW_DESC_RXPKT_LEN:
  547. ret = GET_RX_STATUS_DESC_PKT_LEN(desc);
  548. break;
  549. default:
  550. RT_ASSERT(false, "ERR rxdesc :%d not process\n",
  551. desc_name);
  552. break;
  553. }
  554. }
  555. return ret;
  556. }
  557. void rtl92se_tx_polling(struct ieee80211_hw *hw, u8 hw_queue)
  558. {
  559. struct rtl_priv *rtlpriv = rtl_priv(hw);
  560. rtl_write_word(rtlpriv, TP_POLL, BIT(0) << (hw_queue));
  561. }