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