dp_be_tx.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848
  1. /*
  2. * Copyright (c) 2016-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021 Qualcomm Innovation Center, Inc. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for
  6. * any purpose with or without fee is hereby granted, provided that the
  7. * above copyright notice and this permission notice appear in all
  8. * copies.
  9. *
  10. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  11. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  12. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  13. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  14. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  15. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  16. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  17. * PERFORMANCE OF THIS SOFTWARE.
  18. */
  19. #include "cdp_txrx_cmn_struct.h"
  20. #include "dp_types.h"
  21. #include "dp_tx.h"
  22. #include "dp_be_tx.h"
  23. #include "dp_tx_desc.h"
  24. #include "hal_tx.h"
  25. #include <hal_be_api.h>
  26. #include <hal_be_tx.h>
  27. #include <dp_htt.h>
  28. #ifdef FEATURE_WDS
  29. #include "dp_txrx_wds.h"
  30. #endif
  31. #if defined(WLAN_MAX_PDEVS) && (WLAN_MAX_PDEVS == 1)
  32. #define DP_TX_BANK_LOCK_CREATE(lock) qdf_mutex_create(lock)
  33. #define DP_TX_BANK_LOCK_DESTROY(lock) qdf_mutex_destroy(lock)
  34. #define DP_TX_BANK_LOCK_ACQUIRE(lock) qdf_mutex_acquire(lock)
  35. #define DP_TX_BANK_LOCK_RELEASE(lock) qdf_mutex_release(lock)
  36. #else
  37. #define DP_TX_BANK_LOCK_CREATE(lock) qdf_spinlock_create(lock)
  38. #define DP_TX_BANK_LOCK_DESTROY(lock) qdf_spinlock_destroy(lock)
  39. #define DP_TX_BANK_LOCK_ACQUIRE(lock) qdf_spin_lock_bh(lock)
  40. #define DP_TX_BANK_LOCK_RELEASE(lock) qdf_spin_unlock_bh(lock)
  41. #endif
  42. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP)
  43. #ifdef WLAN_MCAST_MLO
  44. /* MLO peer id for reinject*/
  45. #define DP_MLO_MCAST_REINJECT_PEER_ID 0XFFFD
  46. #define MAX_GSN_NUM 0x0FFF
  47. #endif
  48. #endif
  49. #define DP_TX_WBM_COMPLETION_V3_VDEV_ID_GET(_var) \
  50. HTT_TX_WBM_COMPLETION_V2_VDEV_ID_GET(_var)
  51. #define DP_TX_WBM_COMPLETION_V3_VALID_GET(_var) \
  52. HTT_TX_WBM_COMPLETION_V2_VALID_GET(_var)
  53. #define DP_TX_WBM_COMPLETION_V3_SW_PEER_ID_GET(_var) \
  54. HTT_TX_WBM_COMPLETION_V2_SW_PEER_ID_GET(_var)
  55. #define DP_TX_WBM_COMPLETION_V3_TID_NUM_GET(_var) \
  56. HTT_TX_WBM_COMPLETION_V2_TID_NUM_GET(_var)
  57. #define DP_TX_WBM_COMPLETION_V3_SCH_CMD_ID_GET(_var) \
  58. HTT_TX_WBM_COMPLETION_V2_SCH_CMD_ID_GET(_var)
  59. #define DP_TX_WBM_COMPLETION_V3_ACK_FRAME_RSSI_GET(_var) \
  60. HTT_TX_WBM_COMPLETION_V2_ACK_FRAME_RSSI_GET(_var)
  61. extern uint8_t sec_type_map[MAX_CDP_SEC_TYPE];
  62. #ifdef DP_USE_REDUCED_PEER_ID_FIELD_WIDTH
  63. static inline uint16_t dp_tx_comp_get_peer_id(struct dp_soc *soc,
  64. void *tx_comp_hal_desc)
  65. {
  66. uint16_t peer_id = hal_tx_comp_get_peer_id(tx_comp_hal_desc);
  67. struct dp_tx_comp_peer_id *tx_peer_id =
  68. (struct dp_tx_comp_peer_id *)&peer_id;
  69. return (tx_peer_id->peer_id |
  70. (tx_peer_id->ml_peer_valid << soc->peer_id_shift));
  71. }
  72. #else
  73. /* Combine ml_peer_valid and peer_id field */
  74. #define DP_BE_TX_COMP_PEER_ID_MASK 0x00003fff
  75. #define DP_BE_TX_COMP_PEER_ID_SHIFT 0
  76. static inline uint16_t dp_tx_comp_get_peer_id(struct dp_soc *soc,
  77. void *tx_comp_hal_desc)
  78. {
  79. uint16_t peer_id = hal_tx_comp_get_peer_id(tx_comp_hal_desc);
  80. return ((peer_id & DP_BE_TX_COMP_PEER_ID_MASK) >>
  81. DP_BE_TX_COMP_PEER_ID_SHIFT);
  82. }
  83. #endif
  84. #ifdef DP_FEATURE_HW_COOKIE_CONVERSION
  85. #ifdef DP_HW_COOKIE_CONVERT_EXCEPTION
  86. void dp_tx_comp_get_params_from_hal_desc_be(struct dp_soc *soc,
  87. void *tx_comp_hal_desc,
  88. struct dp_tx_desc_s **r_tx_desc)
  89. {
  90. uint32_t tx_desc_id;
  91. if (qdf_likely(
  92. hal_tx_comp_get_cookie_convert_done(tx_comp_hal_desc))) {
  93. /* HW cookie conversion done */
  94. *r_tx_desc = (struct dp_tx_desc_s *)
  95. hal_tx_comp_get_desc_va(tx_comp_hal_desc);
  96. } else {
  97. /* SW do cookie conversion to VA */
  98. tx_desc_id = hal_tx_comp_get_desc_id(tx_comp_hal_desc);
  99. *r_tx_desc =
  100. (struct dp_tx_desc_s *)dp_cc_desc_find(soc, tx_desc_id);
  101. }
  102. if (*r_tx_desc)
  103. (*r_tx_desc)->peer_id = dp_tx_comp_get_peer_id(soc,
  104. tx_comp_hal_desc);
  105. }
  106. #else
  107. void dp_tx_comp_get_params_from_hal_desc_be(struct dp_soc *soc,
  108. void *tx_comp_hal_desc,
  109. struct dp_tx_desc_s **r_tx_desc)
  110. {
  111. *r_tx_desc = (struct dp_tx_desc_s *)
  112. hal_tx_comp_get_desc_va(tx_comp_hal_desc);
  113. if (*r_tx_desc)
  114. (*r_tx_desc)->peer_id = dp_tx_comp_get_peer_id(soc,
  115. tx_comp_hal_desc);
  116. }
  117. #endif /* DP_HW_COOKIE_CONVERT_EXCEPTION */
  118. #else
  119. void dp_tx_comp_get_params_from_hal_desc_be(struct dp_soc *soc,
  120. void *tx_comp_hal_desc,
  121. struct dp_tx_desc_s **r_tx_desc)
  122. {
  123. uint32_t tx_desc_id;
  124. /* SW do cookie conversion to VA */
  125. tx_desc_id = hal_tx_comp_get_desc_id(tx_comp_hal_desc);
  126. *r_tx_desc =
  127. (struct dp_tx_desc_s *)dp_cc_desc_find(soc, tx_desc_id);
  128. if (*r_tx_desc)
  129. (*r_tx_desc)->peer_id = dp_tx_comp_get_peer_id(soc,
  130. tx_comp_hal_desc);
  131. }
  132. #endif /* DP_FEATURE_HW_COOKIE_CONVERSION */
  133. static inline
  134. void dp_tx_process_mec_notify_be(struct dp_soc *soc, uint8_t *status)
  135. {
  136. struct dp_vdev *vdev;
  137. uint8_t vdev_id;
  138. uint8_t tx_status;
  139. uint32_t *htt_desc = (uint32_t *)status;
  140. tx_status = HTT_TX_WBM_COMPLETION_V3_TX_STATUS_GET(htt_desc[0]);
  141. if (tx_status == HTT_TX_FW2WBM_TX_STATUS_MEC_NOTIFY) {
  142. qdf_assert_always(!soc->mec_fw_offload);
  143. /*
  144. * Get vdev id from HTT status word in case of MEC
  145. * notification
  146. */
  147. vdev_id = DP_TX_WBM_COMPLETION_V3_VDEV_ID_GET(htt_desc[4]);
  148. if (qdf_unlikely(vdev_id >= MAX_VDEV_CNT))
  149. return;
  150. vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  151. DP_MOD_ID_HTT_COMP);
  152. if (!vdev)
  153. return;
  154. dp_tx_mec_handler(vdev, status);
  155. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  156. }
  157. }
  158. void dp_tx_process_htt_completion_be(struct dp_soc *soc,
  159. struct dp_tx_desc_s *tx_desc,
  160. uint8_t *status,
  161. uint8_t ring_id)
  162. {
  163. uint8_t tx_status;
  164. struct dp_pdev *pdev;
  165. struct dp_vdev *vdev = NULL;
  166. struct hal_tx_completion_status ts = {0};
  167. uint32_t *htt_desc = (uint32_t *)status;
  168. struct dp_peer *peer;
  169. struct cdp_tid_tx_stats *tid_stats = NULL;
  170. struct htt_soc *htt_handle;
  171. uint8_t vdev_id;
  172. tx_status = HTT_TX_WBM_COMPLETION_V3_TX_STATUS_GET(htt_desc[0]);
  173. htt_handle = (struct htt_soc *)soc->htt_handle;
  174. htt_wbm_event_record(htt_handle->htt_logger_handle, tx_status, status);
  175. /*
  176. * There can be scenario where WBM consuming descriptor enqueued
  177. * from TQM2WBM first and TQM completion can happen before MEC
  178. * notification comes from FW2WBM. Avoid access any field of tx
  179. * descriptor in case of MEC notify.
  180. */
  181. dp_tx_process_mec_notify_be(soc, status);
  182. /*
  183. * If the descriptor is already freed in vdev_detach,
  184. * continue to next descriptor
  185. */
  186. if (qdf_unlikely(!tx_desc->flags)) {
  187. dp_tx_comp_info_rl("Descriptor freed in vdev_detach %d",
  188. tx_desc->id);
  189. return;
  190. }
  191. if (qdf_unlikely(tx_desc->vdev_id == DP_INVALID_VDEV_ID)) {
  192. dp_tx_comp_info_rl("Invalid vdev_id %d", tx_desc->id);
  193. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  194. goto release_tx_desc;
  195. }
  196. pdev = tx_desc->pdev;
  197. if (qdf_unlikely(tx_desc->pdev->is_pdev_down)) {
  198. dp_tx_comp_info_rl("pdev in down state %d", tx_desc->id);
  199. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  200. goto release_tx_desc;
  201. }
  202. qdf_assert(tx_desc->pdev);
  203. vdev_id = tx_desc->vdev_id;
  204. vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  205. DP_MOD_ID_HTT_COMP);
  206. if (qdf_unlikely(!vdev)) {
  207. dp_tx_comp_info_rl("Unable to get vdev ref %d", tx_desc->id);
  208. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  209. goto release_tx_desc;
  210. }
  211. switch (tx_status) {
  212. case HTT_TX_FW2WBM_TX_STATUS_OK:
  213. case HTT_TX_FW2WBM_TX_STATUS_DROP:
  214. case HTT_TX_FW2WBM_TX_STATUS_TTL:
  215. {
  216. uint8_t tid;
  217. if (DP_TX_WBM_COMPLETION_V3_VALID_GET(htt_desc[3])) {
  218. ts.peer_id =
  219. DP_TX_WBM_COMPLETION_V3_SW_PEER_ID_GET(
  220. htt_desc[3]);
  221. ts.tid =
  222. DP_TX_WBM_COMPLETION_V3_TID_NUM_GET(
  223. htt_desc[3]);
  224. } else {
  225. ts.peer_id = HTT_INVALID_PEER;
  226. ts.tid = HTT_INVALID_TID;
  227. }
  228. ts.release_src = HAL_TX_COMP_RELEASE_SOURCE_FW;
  229. ts.ppdu_id =
  230. DP_TX_WBM_COMPLETION_V3_SCH_CMD_ID_GET(
  231. htt_desc[2]);
  232. ts.ack_frame_rssi =
  233. DP_TX_WBM_COMPLETION_V3_ACK_FRAME_RSSI_GET(
  234. htt_desc[2]);
  235. ts.tsf = htt_desc[4];
  236. ts.first_msdu = 1;
  237. ts.last_msdu = 1;
  238. tid = ts.tid;
  239. if (qdf_unlikely(tid >= CDP_MAX_DATA_TIDS))
  240. tid = CDP_MAX_DATA_TIDS - 1;
  241. tid_stats = &pdev->stats.tid_stats.tid_tx_stats[ring_id][tid];
  242. if (qdf_unlikely(pdev->delay_stats_flag))
  243. dp_tx_compute_delay(vdev, tx_desc, tid, ring_id);
  244. if (tx_status < CDP_MAX_TX_HTT_STATUS)
  245. tid_stats->htt_status_cnt[tx_status]++;
  246. peer = dp_peer_get_ref_by_id(soc, ts.peer_id,
  247. DP_MOD_ID_HTT_COMP);
  248. if (qdf_likely(peer))
  249. dp_tx_update_peer_basic_stats(
  250. peer,
  251. qdf_nbuf_len(tx_desc->nbuf),
  252. tx_status,
  253. pdev->enhanced_stats_en);
  254. dp_tx_comp_process_tx_status(soc, tx_desc, &ts, peer, ring_id);
  255. dp_tx_comp_process_desc(soc, tx_desc, &ts, peer);
  256. dp_tx_desc_release(tx_desc, tx_desc->pool_id);
  257. if (qdf_likely(peer))
  258. dp_peer_unref_delete(peer, DP_MOD_ID_HTT_COMP);
  259. break;
  260. }
  261. case HTT_TX_FW2WBM_TX_STATUS_REINJECT:
  262. {
  263. uint8_t reinject_reason;
  264. reinject_reason =
  265. HTT_TX_WBM_COMPLETION_V3_REINJECT_REASON_GET(
  266. htt_desc[1]);
  267. dp_tx_reinject_handler(soc, vdev, tx_desc,
  268. status, reinject_reason);
  269. break;
  270. }
  271. case HTT_TX_FW2WBM_TX_STATUS_INSPECT:
  272. {
  273. dp_tx_inspect_handler(soc, vdev, tx_desc, status);
  274. break;
  275. }
  276. case HTT_TX_FW2WBM_TX_STATUS_VDEVID_MISMATCH:
  277. {
  278. DP_STATS_INC(vdev, tx_i.dropped.fail_per_pkt_vdev_id_check, 1);
  279. goto release_tx_desc;
  280. }
  281. default:
  282. dp_tx_comp_err("Invalid HTT tx_status %d\n",
  283. tx_status);
  284. goto release_tx_desc;
  285. }
  286. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  287. return;
  288. release_tx_desc:
  289. dp_tx_comp_free_buf(soc, tx_desc);
  290. dp_tx_desc_release(tx_desc, tx_desc->pool_id);
  291. if (vdev)
  292. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  293. }
  294. #ifdef QCA_OL_TX_MULTIQ_SUPPORT
  295. #ifdef DP_TX_IMPLICIT_RBM_MAPPING
  296. /*
  297. * dp_tx_get_rbm_id()- Get the RBM ID for data transmission completion.
  298. * @dp_soc - DP soc structure pointer
  299. * @ring_id - Transmit Queue/ring_id to be used when XPS is enabled
  300. *
  301. * Return - RBM ID corresponding to TCL ring_id
  302. */
  303. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  304. uint8_t ring_id)
  305. {
  306. return 0;
  307. }
  308. #else
  309. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  310. uint8_t ring_id)
  311. {
  312. return (ring_id ? soc->wbm_sw0_bm_id + (ring_id - 1) :
  313. HAL_WBM_SW2_BM_ID(soc->wbm_sw0_bm_id));
  314. }
  315. #endif /*DP_TX_IMPLICIT_RBM_MAPPING*/
  316. #else
  317. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  318. uint8_t tcl_index)
  319. {
  320. uint8_t rbm;
  321. rbm = wlan_cfg_get_rbm_id_for_index(soc->wlan_cfg_ctx, tcl_index);
  322. dp_verbose_debug("tcl_id %u rbm %u", tcl_index, rbm);
  323. return rbm;
  324. }
  325. #endif
  326. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  327. defined(WLAN_MCAST_MLO)
  328. void
  329. dp_tx_mlo_mcast_pkt_send(struct dp_vdev_be *be_vdev,
  330. struct dp_vdev *ptnr_vdev,
  331. void *arg)
  332. {
  333. qdf_nbuf_t nbuf = (qdf_nbuf_t)arg;
  334. qdf_nbuf_t nbuf_clone;
  335. struct dp_vdev_be *be_ptnr_vdev = NULL;
  336. struct dp_tx_msdu_info_s msdu_info;
  337. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  338. if (be_vdev != be_ptnr_vdev) {
  339. nbuf_clone = qdf_nbuf_clone(nbuf);
  340. if (qdf_unlikely(!nbuf_clone)) {
  341. dp_tx_debug("nbuf clone failed");
  342. return;
  343. }
  344. } else {
  345. nbuf_clone = nbuf;
  346. }
  347. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  348. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  349. msdu_info.gsn = be_vdev->seq_num;
  350. be_ptnr_vdev->seq_num = be_vdev->seq_num;
  351. nbuf_clone = dp_tx_send_msdu_single(
  352. ptnr_vdev,
  353. nbuf_clone,
  354. &msdu_info,
  355. DP_MLO_MCAST_REINJECT_PEER_ID,
  356. NULL);
  357. if (qdf_unlikely(nbuf_clone)) {
  358. dp_info("pkt send failed");
  359. qdf_nbuf_free(nbuf_clone);
  360. return;
  361. }
  362. }
  363. static inline void
  364. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  365. struct dp_vdev *vdev,
  366. struct dp_tx_msdu_info_s *msdu_info)
  367. {
  368. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, msdu_info->vdev_id);
  369. }
  370. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  371. struct dp_vdev *vdev,
  372. qdf_nbuf_t nbuf)
  373. {
  374. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  375. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  376. /* send frame on partner vdevs */
  377. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  378. dp_tx_mlo_mcast_pkt_send,
  379. nbuf, DP_MOD_ID_TX);
  380. /* send frame on mcast primary vdev */
  381. dp_tx_mlo_mcast_pkt_send(be_vdev, vdev, nbuf);
  382. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  383. be_vdev->seq_num = 0;
  384. else
  385. be_vdev->seq_num++;
  386. }
  387. #else
  388. static inline void
  389. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  390. struct dp_vdev *vdev,
  391. struct dp_tx_msdu_info_s *msdu_info)
  392. {
  393. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, vdev->vdev_id);
  394. }
  395. #endif
  396. #if defined(WLAN_FEATURE_11BE_MLO) && !defined(WLAN_MLO_MULTI_CHIP) && \
  397. !defined(WLAN_MCAST_MLO)
  398. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  399. struct dp_vdev *vdev,
  400. qdf_nbuf_t nbuf)
  401. {
  402. }
  403. #endif
  404. QDF_STATUS
  405. dp_tx_hw_enqueue_be(struct dp_soc *soc, struct dp_vdev *vdev,
  406. struct dp_tx_desc_s *tx_desc, uint16_t fw_metadata,
  407. struct cdp_tx_exception_metadata *tx_exc_metadata,
  408. struct dp_tx_msdu_info_s *msdu_info)
  409. {
  410. void *hal_tx_desc;
  411. uint32_t *hal_tx_desc_cached;
  412. int coalesce = 0;
  413. struct dp_tx_queue *tx_q = &msdu_info->tx_queue;
  414. uint8_t ring_id = tx_q->ring_id;
  415. uint8_t tid = msdu_info->tid;
  416. struct dp_vdev_be *be_vdev;
  417. uint8_t cached_desc[HAL_TX_DESC_LEN_BYTES] = { 0 };
  418. uint8_t bm_id = dp_tx_get_rbm_id_be(soc, ring_id);
  419. hal_ring_handle_t hal_ring_hdl = NULL;
  420. QDF_STATUS status = QDF_STATUS_E_RESOURCES;
  421. be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  422. if (!dp_tx_is_desc_id_valid(soc, tx_desc->id)) {
  423. dp_err_rl("Invalid tx desc id:%d", tx_desc->id);
  424. return QDF_STATUS_E_RESOURCES;
  425. }
  426. if (qdf_unlikely(tx_exc_metadata)) {
  427. qdf_assert_always((tx_exc_metadata->tx_encap_type ==
  428. CDP_INVALID_TX_ENCAP_TYPE) ||
  429. (tx_exc_metadata->tx_encap_type ==
  430. vdev->tx_encap_type));
  431. if (tx_exc_metadata->tx_encap_type == htt_cmn_pkt_type_raw)
  432. qdf_assert_always((tx_exc_metadata->sec_type ==
  433. CDP_INVALID_SEC_TYPE) ||
  434. tx_exc_metadata->sec_type ==
  435. vdev->sec_type);
  436. }
  437. hal_tx_desc_cached = (void *)cached_desc;
  438. hal_tx_desc_set_buf_addr_be(soc->hal_soc, hal_tx_desc_cached,
  439. tx_desc->dma_addr, bm_id, tx_desc->id,
  440. (tx_desc->flags & DP_TX_DESC_FLAG_FRAG));
  441. hal_tx_desc_set_lmac_id_be(soc->hal_soc, hal_tx_desc_cached,
  442. vdev->lmac_id);
  443. hal_tx_desc_set_search_index_be(soc->hal_soc, hal_tx_desc_cached,
  444. vdev->bss_ast_idx);
  445. /*
  446. * Bank_ID is used as DSCP_TABLE number in beryllium
  447. * So there is no explicit field used for DSCP_TID_TABLE_NUM.
  448. */
  449. hal_tx_desc_set_cache_set_num(soc->hal_soc, hal_tx_desc_cached,
  450. (vdev->bss_ast_hash & 0xF));
  451. hal_tx_desc_set_fw_metadata(hal_tx_desc_cached, fw_metadata);
  452. hal_tx_desc_set_buf_length(hal_tx_desc_cached, tx_desc->length);
  453. hal_tx_desc_set_buf_offset(hal_tx_desc_cached, tx_desc->pkt_offset);
  454. if (tx_desc->flags & DP_TX_DESC_FLAG_TO_FW)
  455. hal_tx_desc_set_to_fw(hal_tx_desc_cached, 1);
  456. /* verify checksum offload configuration*/
  457. if ((qdf_nbuf_get_tx_cksum(tx_desc->nbuf) ==
  458. QDF_NBUF_TX_CKSUM_TCP_UDP) ||
  459. qdf_nbuf_is_tso(tx_desc->nbuf)) {
  460. hal_tx_desc_set_l3_checksum_en(hal_tx_desc_cached, 1);
  461. hal_tx_desc_set_l4_checksum_en(hal_tx_desc_cached, 1);
  462. }
  463. hal_tx_desc_set_bank_id(hal_tx_desc_cached, be_vdev->bank_id);
  464. dp_tx_vdev_id_set_hal_tx_desc(hal_tx_desc_cached, vdev, msdu_info);
  465. if (tid != HTT_TX_EXT_TID_INVALID)
  466. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached, tid);
  467. if (qdf_unlikely(vdev->pdev->delay_stats_flag) ||
  468. qdf_unlikely(wlan_cfg_is_peer_ext_stats_enabled(soc->wlan_cfg_ctx)))
  469. tx_desc->timestamp = qdf_ktime_to_ms(qdf_ktime_real_get());
  470. dp_verbose_debug("length:%d , type = %d, dma_addr %llx, offset %d desc id %u",
  471. tx_desc->length,
  472. (tx_desc->flags & DP_TX_DESC_FLAG_FRAG),
  473. (uint64_t)tx_desc->dma_addr, tx_desc->pkt_offset,
  474. tx_desc->id);
  475. hal_ring_hdl = dp_tx_get_hal_ring_hdl(soc, ring_id);
  476. if (qdf_unlikely(dp_tx_hal_ring_access_start(soc, hal_ring_hdl))) {
  477. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  478. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  479. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  480. return status;
  481. }
  482. hal_tx_desc = hal_srng_src_get_next(soc->hal_soc, hal_ring_hdl);
  483. if (qdf_unlikely(!hal_tx_desc)) {
  484. dp_verbose_debug("TCL ring full ring_id:%d", ring_id);
  485. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  486. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  487. goto ring_access_fail;
  488. }
  489. tx_desc->flags |= DP_TX_DESC_FLAG_QUEUED_TX;
  490. dp_vdev_peer_stats_update_protocol_cnt_tx(vdev, tx_desc->nbuf);
  491. /* Sync cached descriptor with HW */
  492. hal_tx_desc_sync(hal_tx_desc_cached, hal_tx_desc);
  493. coalesce = dp_tx_attempt_coalescing(soc, vdev, tx_desc, tid);
  494. DP_STATS_INC_PKT(vdev, tx_i.processed, 1, tx_desc->length);
  495. dp_tx_update_stats(soc, tx_desc->nbuf);
  496. status = QDF_STATUS_SUCCESS;
  497. dp_tx_hw_desc_update_evt((uint8_t *)hal_tx_desc_cached,
  498. hal_ring_hdl, soc);
  499. ring_access_fail:
  500. dp_tx_ring_access_end_wrapper(soc, hal_ring_hdl, coalesce);
  501. return status;
  502. }
  503. QDF_STATUS dp_tx_init_bank_profiles(struct dp_soc_be *be_soc)
  504. {
  505. int i, num_tcl_banks;
  506. num_tcl_banks = hal_tx_get_num_tcl_banks(be_soc->soc.hal_soc);
  507. qdf_assert_always(num_tcl_banks);
  508. be_soc->num_bank_profiles = num_tcl_banks;
  509. be_soc->bank_profiles = qdf_mem_malloc(num_tcl_banks *
  510. sizeof(*be_soc->bank_profiles));
  511. if (!be_soc->bank_profiles) {
  512. dp_err("unable to allocate memory for DP TX Profiles!");
  513. return QDF_STATUS_E_NOMEM;
  514. }
  515. DP_TX_BANK_LOCK_CREATE(&be_soc->tx_bank_lock);
  516. for (i = 0; i < num_tcl_banks; i++) {
  517. be_soc->bank_profiles[i].is_configured = false;
  518. qdf_atomic_init(&be_soc->bank_profiles[i].ref_count);
  519. }
  520. dp_info("initialized %u bank profiles", be_soc->num_bank_profiles);
  521. return QDF_STATUS_SUCCESS;
  522. }
  523. void dp_tx_deinit_bank_profiles(struct dp_soc_be *be_soc)
  524. {
  525. qdf_mem_free(be_soc->bank_profiles);
  526. DP_TX_BANK_LOCK_DESTROY(&be_soc->tx_bank_lock);
  527. }
  528. static
  529. void dp_tx_get_vdev_bank_config(struct dp_vdev_be *be_vdev,
  530. union hal_tx_bank_config *bank_config)
  531. {
  532. struct dp_vdev *vdev = &be_vdev->vdev;
  533. struct dp_soc *soc = vdev->pdev->soc;
  534. bank_config->epd = 0;
  535. bank_config->encap_type = vdev->tx_encap_type;
  536. /* Only valid for raw frames. Needs work for RAW mode */
  537. if (vdev->tx_encap_type == htt_cmn_pkt_type_raw) {
  538. bank_config->encrypt_type = sec_type_map[vdev->sec_type];
  539. } else {
  540. bank_config->encrypt_type = 0;
  541. }
  542. bank_config->src_buffer_swap = 0;
  543. bank_config->link_meta_swap = 0;
  544. if ((soc->sta_mode_search_policy == HAL_TX_ADDR_INDEX_SEARCH) &&
  545. vdev->opmode == wlan_op_mode_sta) {
  546. bank_config->index_lookup_enable = 1;
  547. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_MEC_NOTIFY;
  548. bank_config->addrx_en = 0;
  549. bank_config->addry_en = 0;
  550. } else {
  551. bank_config->index_lookup_enable = 0;
  552. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_FW_EXCEPTION;
  553. bank_config->addrx_en =
  554. (vdev->hal_desc_addr_search_flags &
  555. HAL_TX_DESC_ADDRX_EN) ? 1 : 0;
  556. bank_config->addry_en =
  557. (vdev->hal_desc_addr_search_flags &
  558. HAL_TX_DESC_ADDRY_EN) ? 1 : 0;
  559. }
  560. bank_config->mesh_enable = vdev->mesh_vdev ? 1 : 0;
  561. bank_config->dscp_tid_map_id = vdev->dscp_tid_map_id;
  562. /* Disabling vdev id check for now. Needs revist. */
  563. bank_config->vdev_id_check_en = be_vdev->vdev_id_check_en;
  564. bank_config->pmac_id = vdev->lmac_id;
  565. }
  566. int dp_tx_get_bank_profile(struct dp_soc_be *be_soc,
  567. struct dp_vdev_be *be_vdev)
  568. {
  569. char *temp_str = "";
  570. bool found_match = false;
  571. int bank_id = DP_BE_INVALID_BANK_ID;
  572. int i;
  573. int unconfigured_slot = DP_BE_INVALID_BANK_ID;
  574. int zero_ref_count_slot = DP_BE_INVALID_BANK_ID;
  575. union hal_tx_bank_config vdev_config = {0};
  576. /* convert vdev params into hal_tx_bank_config */
  577. dp_tx_get_vdev_bank_config(be_vdev, &vdev_config);
  578. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  579. /* go over all banks and find a matching/unconfigured/unsed bank */
  580. for (i = 0; i < be_soc->num_bank_profiles; i++) {
  581. if (be_soc->bank_profiles[i].is_configured &&
  582. (be_soc->bank_profiles[i].bank_config.val ^
  583. vdev_config.val) == 0) {
  584. found_match = true;
  585. break;
  586. }
  587. if (unconfigured_slot == DP_BE_INVALID_BANK_ID &&
  588. !be_soc->bank_profiles[i].is_configured)
  589. unconfigured_slot = i;
  590. else if (zero_ref_count_slot == DP_BE_INVALID_BANK_ID &&
  591. !qdf_atomic_read(&be_soc->bank_profiles[i].ref_count))
  592. zero_ref_count_slot = i;
  593. }
  594. if (found_match) {
  595. temp_str = "matching";
  596. bank_id = i;
  597. goto inc_ref_and_return;
  598. }
  599. if (unconfigured_slot != DP_BE_INVALID_BANK_ID) {
  600. temp_str = "unconfigured";
  601. bank_id = unconfigured_slot;
  602. goto configure_and_return;
  603. }
  604. if (zero_ref_count_slot != DP_BE_INVALID_BANK_ID) {
  605. temp_str = "zero_ref_count";
  606. bank_id = zero_ref_count_slot;
  607. }
  608. if (bank_id == DP_BE_INVALID_BANK_ID) {
  609. dp_alert("unable to find TX bank!");
  610. QDF_BUG(0);
  611. return bank_id;
  612. }
  613. configure_and_return:
  614. be_soc->bank_profiles[bank_id].is_configured = true;
  615. be_soc->bank_profiles[bank_id].bank_config.val = vdev_config.val;
  616. hal_tx_populate_bank_register(be_soc->soc.hal_soc,
  617. &be_soc->bank_profiles[bank_id].bank_config,
  618. bank_id);
  619. inc_ref_and_return:
  620. qdf_atomic_inc(&be_soc->bank_profiles[bank_id].ref_count);
  621. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  622. dp_info("found %s slot at index %d, input:0x%x match:0x%x ref_count %u",
  623. temp_str, bank_id, vdev_config.val,
  624. be_soc->bank_profiles[bank_id].bank_config.val,
  625. qdf_atomic_read(&be_soc->bank_profiles[bank_id].ref_count));
  626. dp_info("epd:%x encap:%x encryp:%x src_buf_swap:%x link_meta_swap:%x addrx_en:%x addry_en:%x mesh_en:%x vdev_id_check:%x pmac_id:%x mcast_pkt_ctrl:%x",
  627. be_soc->bank_profiles[bank_id].bank_config.epd,
  628. be_soc->bank_profiles[bank_id].bank_config.encap_type,
  629. be_soc->bank_profiles[bank_id].bank_config.encrypt_type,
  630. be_soc->bank_profiles[bank_id].bank_config.src_buffer_swap,
  631. be_soc->bank_profiles[bank_id].bank_config.link_meta_swap,
  632. be_soc->bank_profiles[bank_id].bank_config.addrx_en,
  633. be_soc->bank_profiles[bank_id].bank_config.addry_en,
  634. be_soc->bank_profiles[bank_id].bank_config.mesh_enable,
  635. be_soc->bank_profiles[bank_id].bank_config.vdev_id_check_en,
  636. be_soc->bank_profiles[bank_id].bank_config.pmac_id,
  637. be_soc->bank_profiles[bank_id].bank_config.mcast_pkt_ctrl);
  638. return bank_id;
  639. }
  640. void dp_tx_put_bank_profile(struct dp_soc_be *be_soc,
  641. struct dp_vdev_be *be_vdev)
  642. {
  643. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  644. qdf_atomic_dec(&be_soc->bank_profiles[be_vdev->bank_id].ref_count);
  645. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  646. }
  647. void dp_tx_update_bank_profile(struct dp_soc_be *be_soc,
  648. struct dp_vdev_be *be_vdev)
  649. {
  650. dp_tx_put_bank_profile(be_soc, be_vdev);
  651. be_vdev->bank_id = dp_tx_get_bank_profile(be_soc, be_vdev);
  652. }
  653. QDF_STATUS dp_tx_desc_pool_init_be(struct dp_soc *soc,
  654. uint16_t num_elem,
  655. uint8_t pool_id)
  656. {
  657. struct dp_tx_desc_pool_s *tx_desc_pool;
  658. struct dp_hw_cookie_conversion_t *cc_ctx;
  659. struct dp_soc_be *be_soc;
  660. struct dp_spt_page_desc *page_desc;
  661. struct dp_tx_desc_s *tx_desc;
  662. uint32_t ppt_idx = 0;
  663. uint32_t avail_entry_index = 0;
  664. if (!num_elem) {
  665. dp_err("desc_num 0 !!");
  666. return QDF_STATUS_E_FAILURE;
  667. }
  668. be_soc = dp_get_be_soc_from_dp_soc(soc);
  669. tx_desc_pool = &soc->tx_desc[pool_id];
  670. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  671. tx_desc = tx_desc_pool->freelist;
  672. page_desc = &cc_ctx->page_desc_base[0];
  673. while (tx_desc) {
  674. if (avail_entry_index == 0) {
  675. if (ppt_idx >= cc_ctx->total_page_num) {
  676. dp_alert("insufficient secondary page tables");
  677. qdf_assert_always(0);
  678. }
  679. page_desc = &cc_ctx->page_desc_base[ppt_idx++];
  680. }
  681. /* put each TX Desc VA to SPT pages and
  682. * get corresponding ID
  683. */
  684. DP_CC_SPT_PAGE_UPDATE_VA(page_desc->page_v_addr,
  685. avail_entry_index,
  686. tx_desc);
  687. tx_desc->id =
  688. dp_cc_desc_id_generate(page_desc->ppt_index,
  689. avail_entry_index);
  690. tx_desc->pool_id = pool_id;
  691. tx_desc = tx_desc->next;
  692. avail_entry_index = (avail_entry_index + 1) &
  693. DP_CC_SPT_PAGE_MAX_ENTRIES_MASK;
  694. }
  695. return QDF_STATUS_SUCCESS;
  696. }
  697. void dp_tx_desc_pool_deinit_be(struct dp_soc *soc,
  698. struct dp_tx_desc_pool_s *tx_desc_pool,
  699. uint8_t pool_id)
  700. {
  701. struct dp_spt_page_desc *page_desc;
  702. struct dp_soc_be *be_soc;
  703. int i = 0;
  704. struct dp_hw_cookie_conversion_t *cc_ctx;
  705. be_soc = dp_get_be_soc_from_dp_soc(soc);
  706. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  707. for (i = 0; i < cc_ctx->total_page_num; i++) {
  708. page_desc = &cc_ctx->page_desc_base[i];
  709. qdf_mem_zero(page_desc->page_v_addr, qdf_page_size);
  710. }
  711. }
  712. #ifdef WLAN_FEATURE_NEAR_FULL_IRQ
  713. uint32_t dp_tx_comp_nf_handler(struct dp_intr *int_ctx, struct dp_soc *soc,
  714. hal_ring_handle_t hal_ring_hdl, uint8_t ring_id,
  715. uint32_t quota)
  716. {
  717. struct dp_srng *tx_comp_ring = &soc->tx_comp_ring[ring_id];
  718. uint32_t work_done = 0;
  719. if (dp_srng_get_near_full_level(soc, tx_comp_ring) <
  720. DP_SRNG_THRESH_NEAR_FULL)
  721. return 0;
  722. qdf_atomic_set(&tx_comp_ring->near_full, 1);
  723. work_done++;
  724. return work_done;
  725. }
  726. #endif