dp_be_tx.c 30 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039
  1. /*
  2. * Copyright (c) 2016-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2022 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. uint32_t *htt_desc = (uint32_t *)status;
  139. qdf_assert_always(!soc->mec_fw_offload);
  140. /*
  141. * Get vdev id from HTT status word in case of MEC
  142. * notification
  143. */
  144. vdev_id = DP_TX_WBM_COMPLETION_V3_VDEV_ID_GET(htt_desc[4]);
  145. if (qdf_unlikely(vdev_id >= MAX_VDEV_CNT))
  146. return;
  147. vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  148. DP_MOD_ID_HTT_COMP);
  149. if (!vdev)
  150. return;
  151. dp_tx_mec_handler(vdev, status);
  152. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  153. }
  154. void dp_tx_process_htt_completion_be(struct dp_soc *soc,
  155. struct dp_tx_desc_s *tx_desc,
  156. uint8_t *status,
  157. uint8_t ring_id)
  158. {
  159. uint8_t tx_status;
  160. struct dp_pdev *pdev;
  161. struct dp_vdev *vdev = NULL;
  162. struct hal_tx_completion_status ts = {0};
  163. uint32_t *htt_desc = (uint32_t *)status;
  164. struct dp_txrx_peer *txrx_peer;
  165. dp_txrx_ref_handle txrx_ref_handle = NULL;
  166. struct cdp_tid_tx_stats *tid_stats = NULL;
  167. struct htt_soc *htt_handle;
  168. uint8_t vdev_id;
  169. tx_status = HTT_TX_WBM_COMPLETION_V3_TX_STATUS_GET(htt_desc[0]);
  170. htt_handle = (struct htt_soc *)soc->htt_handle;
  171. htt_wbm_event_record(htt_handle->htt_logger_handle, tx_status, status);
  172. /*
  173. * There can be scenario where WBM consuming descriptor enqueued
  174. * from TQM2WBM first and TQM completion can happen before MEC
  175. * notification comes from FW2WBM. Avoid access any field of tx
  176. * descriptor in case of MEC notify.
  177. */
  178. if (tx_status == HTT_TX_FW2WBM_TX_STATUS_MEC_NOTIFY)
  179. return dp_tx_process_mec_notify_be(soc, status);
  180. /*
  181. * If the descriptor is already freed in vdev_detach,
  182. * continue to next descriptor
  183. */
  184. if (qdf_unlikely(!tx_desc->flags)) {
  185. dp_tx_comp_info_rl("Descriptor freed in vdev_detach %d",
  186. tx_desc->id);
  187. return;
  188. }
  189. if (qdf_unlikely(tx_desc->vdev_id == DP_INVALID_VDEV_ID)) {
  190. dp_tx_comp_info_rl("Invalid vdev_id %d", tx_desc->id);
  191. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  192. goto release_tx_desc;
  193. }
  194. pdev = tx_desc->pdev;
  195. if (qdf_unlikely(tx_desc->pdev->is_pdev_down)) {
  196. dp_tx_comp_info_rl("pdev in down state %d", tx_desc->id);
  197. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  198. goto release_tx_desc;
  199. }
  200. qdf_assert(tx_desc->pdev);
  201. vdev_id = tx_desc->vdev_id;
  202. vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  203. DP_MOD_ID_HTT_COMP);
  204. if (qdf_unlikely(!vdev)) {
  205. dp_tx_comp_info_rl("Unable to get vdev ref %d", tx_desc->id);
  206. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  207. goto release_tx_desc;
  208. }
  209. switch (tx_status) {
  210. case HTT_TX_FW2WBM_TX_STATUS_OK:
  211. case HTT_TX_FW2WBM_TX_STATUS_DROP:
  212. case HTT_TX_FW2WBM_TX_STATUS_TTL:
  213. {
  214. uint8_t tid;
  215. if (DP_TX_WBM_COMPLETION_V3_VALID_GET(htt_desc[3])) {
  216. ts.peer_id =
  217. DP_TX_WBM_COMPLETION_V3_SW_PEER_ID_GET(
  218. htt_desc[3]);
  219. ts.tid =
  220. DP_TX_WBM_COMPLETION_V3_TID_NUM_GET(
  221. htt_desc[3]);
  222. } else {
  223. ts.peer_id = HTT_INVALID_PEER;
  224. ts.tid = HTT_INVALID_TID;
  225. }
  226. ts.release_src = HAL_TX_COMP_RELEASE_SOURCE_FW;
  227. ts.ppdu_id =
  228. DP_TX_WBM_COMPLETION_V3_SCH_CMD_ID_GET(
  229. htt_desc[2]);
  230. ts.ack_frame_rssi =
  231. DP_TX_WBM_COMPLETION_V3_ACK_FRAME_RSSI_GET(
  232. htt_desc[2]);
  233. ts.tsf = htt_desc[4];
  234. ts.first_msdu = 1;
  235. ts.last_msdu = 1;
  236. ts.status = (tx_status == HTT_TX_FW2WBM_TX_STATUS_OK ?
  237. HAL_TX_TQM_RR_FRAME_ACKED :
  238. HAL_TX_TQM_RR_REM_CMD_REM);
  239. tid = ts.tid;
  240. if (qdf_unlikely(tid >= CDP_MAX_DATA_TIDS))
  241. tid = CDP_MAX_DATA_TIDS - 1;
  242. tid_stats = &pdev->stats.tid_stats.tid_tx_stats[ring_id][tid];
  243. if (qdf_unlikely(pdev->delay_stats_flag) ||
  244. qdf_unlikely(dp_is_vdev_tx_delay_stats_enabled(vdev)))
  245. dp_tx_compute_delay(vdev, tx_desc, tid, ring_id);
  246. if (tx_status < CDP_MAX_TX_HTT_STATUS)
  247. tid_stats->htt_status_cnt[tx_status]++;
  248. txrx_peer = dp_txrx_peer_get_ref_by_id(soc, ts.peer_id,
  249. &txrx_ref_handle,
  250. DP_MOD_ID_HTT_COMP);
  251. if (qdf_likely(txrx_peer))
  252. dp_tx_update_peer_basic_stats(
  253. txrx_peer,
  254. qdf_nbuf_len(tx_desc->nbuf),
  255. tx_status,
  256. pdev->enhanced_stats_en);
  257. dp_tx_comp_process_tx_status(soc, tx_desc, &ts, txrx_peer,
  258. ring_id);
  259. dp_tx_comp_process_desc(soc, tx_desc, &ts, txrx_peer);
  260. dp_tx_desc_release(tx_desc, tx_desc->pool_id);
  261. if (qdf_likely(txrx_peer))
  262. dp_txrx_peer_unref_delete(txrx_ref_handle,
  263. DP_MOD_ID_HTT_COMP);
  264. break;
  265. }
  266. case HTT_TX_FW2WBM_TX_STATUS_REINJECT:
  267. {
  268. uint8_t reinject_reason;
  269. reinject_reason =
  270. HTT_TX_WBM_COMPLETION_V3_REINJECT_REASON_GET(
  271. htt_desc[1]);
  272. dp_tx_reinject_handler(soc, vdev, tx_desc,
  273. status, reinject_reason);
  274. break;
  275. }
  276. case HTT_TX_FW2WBM_TX_STATUS_INSPECT:
  277. {
  278. dp_tx_inspect_handler(soc, vdev, tx_desc, status);
  279. break;
  280. }
  281. case HTT_TX_FW2WBM_TX_STATUS_VDEVID_MISMATCH:
  282. {
  283. DP_STATS_INC(vdev, tx_i.dropped.fail_per_pkt_vdev_id_check, 1);
  284. goto release_tx_desc;
  285. }
  286. default:
  287. dp_tx_comp_err("Invalid HTT tx_status %d\n",
  288. tx_status);
  289. goto release_tx_desc;
  290. }
  291. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  292. return;
  293. release_tx_desc:
  294. dp_tx_comp_free_buf(soc, tx_desc);
  295. dp_tx_desc_release(tx_desc, tx_desc->pool_id);
  296. if (vdev)
  297. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  298. }
  299. #ifdef QCA_OL_TX_MULTIQ_SUPPORT
  300. #ifdef DP_TX_IMPLICIT_RBM_MAPPING
  301. /*
  302. * dp_tx_get_rbm_id()- Get the RBM ID for data transmission completion.
  303. * @dp_soc - DP soc structure pointer
  304. * @ring_id - Transmit Queue/ring_id to be used when XPS is enabled
  305. *
  306. * Return - RBM ID corresponding to TCL ring_id
  307. */
  308. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  309. uint8_t ring_id)
  310. {
  311. return 0;
  312. }
  313. #else
  314. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  315. uint8_t ring_id)
  316. {
  317. return (ring_id ? soc->wbm_sw0_bm_id + (ring_id - 1) :
  318. HAL_WBM_SW2_BM_ID(soc->wbm_sw0_bm_id));
  319. }
  320. #endif /*DP_TX_IMPLICIT_RBM_MAPPING*/
  321. #else
  322. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  323. uint8_t tcl_index)
  324. {
  325. uint8_t rbm;
  326. rbm = wlan_cfg_get_rbm_id_for_index(soc->wlan_cfg_ctx, tcl_index);
  327. dp_verbose_debug("tcl_id %u rbm %u", tcl_index, rbm);
  328. return rbm;
  329. }
  330. #endif
  331. #ifdef QCA_SUPPORT_TX_MIN_RATES_FOR_SPECIAL_FRAMES
  332. /*
  333. * dp_tx_set_min_rates_for_critical_frames()- sets min-rates for critical pkts
  334. * @dp_soc - DP soc structure pointer
  335. * @hal_tx_desc - HAL descriptor where fields are set
  336. * nbuf - skb to be considered for min rates
  337. *
  338. * The function relies on upper layers to set QDF_NBUF_CB_TX_EXTRA_IS_CRITICAL
  339. * and uses it to determine if the frame is critical. For a critical frame,
  340. * flow override bits are set to classify the frame into HW's high priority
  341. * queue. The HW will pick pre-configured min rates for such packets.
  342. *
  343. * Return - None
  344. */
  345. static void
  346. dp_tx_set_min_rates_for_critical_frames(struct dp_soc *soc,
  347. uint32_t *hal_tx_desc,
  348. qdf_nbuf_t nbuf)
  349. {
  350. /*
  351. * Critical frames should be queued to the high priority queue for the TID on
  352. * on which they are sent out (for the concerned peer).
  353. * FW is using HTT_MSDU_Q_IDX 2 for HOL (high priority) queue.
  354. * htt_msdu_idx = (2 * who_classify_info_sel) + flow_override
  355. * Hence, using who_classify_info_sel = 1, flow_override = 0 to select
  356. * HOL queue.
  357. */
  358. if (QDF_NBUF_CB_TX_EXTRA_IS_CRITICAL(nbuf)) {
  359. hal_tx_desc_set_flow_override_enable(hal_tx_desc, 1);
  360. hal_tx_desc_set_flow_override(hal_tx_desc, 0);
  361. hal_tx_desc_set_who_classify_info_sel(hal_tx_desc, 1);
  362. hal_tx_desc_set_tx_notify_frame(hal_tx_desc,
  363. TX_SEMI_HARD_NOTIFY_E);
  364. }
  365. }
  366. #else
  367. static inline void
  368. dp_tx_set_min_rates_for_critical_frames(struct dp_soc *soc,
  369. uint32_t *hal_tx_desc_cached,
  370. qdf_nbuf_t nbuf)
  371. {
  372. }
  373. #endif
  374. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  375. defined(WLAN_MCAST_MLO)
  376. void dp_tx_mcast_mlo_reinject_routing_set(struct dp_soc *soc, void *arg)
  377. {
  378. hal_soc_handle_t hal_soc = soc->hal_soc;
  379. uint8_t *cmd = (uint8_t *)arg;
  380. if (*cmd)
  381. hal_tx_mcast_mlo_reinject_routing_set(
  382. hal_soc,
  383. HAL_TX_MCAST_MLO_REINJECT_TQM_NOTIFY);
  384. else
  385. hal_tx_mcast_mlo_reinject_routing_set(
  386. hal_soc,
  387. HAL_TX_MCAST_MLO_REINJECT_FW_NOTIFY);
  388. }
  389. void
  390. dp_tx_mlo_mcast_pkt_send(struct dp_vdev_be *be_vdev,
  391. struct dp_vdev *ptnr_vdev,
  392. void *arg)
  393. {
  394. qdf_nbuf_t nbuf = (qdf_nbuf_t)arg;
  395. qdf_nbuf_t nbuf_clone;
  396. struct dp_vdev_be *be_ptnr_vdev = NULL;
  397. struct dp_tx_msdu_info_s msdu_info;
  398. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  399. if (be_vdev != be_ptnr_vdev) {
  400. nbuf_clone = qdf_nbuf_clone(nbuf);
  401. if (qdf_unlikely(!nbuf_clone)) {
  402. dp_tx_debug("nbuf clone failed");
  403. return;
  404. }
  405. } else {
  406. nbuf_clone = nbuf;
  407. }
  408. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  409. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  410. msdu_info.gsn = be_vdev->seq_num;
  411. be_ptnr_vdev->seq_num = be_vdev->seq_num;
  412. nbuf_clone = dp_tx_send_msdu_single(
  413. ptnr_vdev,
  414. nbuf_clone,
  415. &msdu_info,
  416. DP_MLO_MCAST_REINJECT_PEER_ID,
  417. NULL);
  418. if (qdf_unlikely(nbuf_clone)) {
  419. dp_info("pkt send failed");
  420. qdf_nbuf_free(nbuf_clone);
  421. return;
  422. }
  423. }
  424. static inline void
  425. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  426. struct dp_vdev *vdev,
  427. struct dp_tx_msdu_info_s *msdu_info)
  428. {
  429. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, msdu_info->vdev_id);
  430. }
  431. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  432. struct dp_vdev *vdev,
  433. qdf_nbuf_t nbuf)
  434. {
  435. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  436. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  437. /* send frame on partner vdevs */
  438. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  439. dp_tx_mlo_mcast_pkt_send,
  440. nbuf, DP_MOD_ID_REINJECT);
  441. /* send frame on mcast primary vdev */
  442. dp_tx_mlo_mcast_pkt_send(be_vdev, vdev, nbuf);
  443. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  444. be_vdev->seq_num = 0;
  445. else
  446. be_vdev->seq_num++;
  447. }
  448. #else
  449. static inline void
  450. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  451. struct dp_vdev *vdev,
  452. struct dp_tx_msdu_info_s *msdu_info)
  453. {
  454. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, vdev->vdev_id);
  455. }
  456. #endif
  457. #if defined(WLAN_FEATURE_11BE_MLO) && !defined(WLAN_MLO_MULTI_CHIP) && \
  458. !defined(WLAN_MCAST_MLO)
  459. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  460. struct dp_vdev *vdev,
  461. qdf_nbuf_t nbuf)
  462. {
  463. }
  464. #endif
  465. #ifdef CONFIG_SAWF
  466. void dp_sawf_config_be(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  467. uint16_t *fw_metadata, qdf_nbuf_t nbuf)
  468. {
  469. uint8_t q_id = 0;
  470. if (!wlan_cfg_get_sawf_config(soc->wlan_cfg_ctx))
  471. return;
  472. dp_sawf_tcl_cmd(fw_metadata, nbuf);
  473. q_id = dp_sawf_queue_id_get(nbuf);
  474. if (q_id == DP_SAWF_DEFAULT_Q_INVALID)
  475. return;
  476. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached, DP_TX_HLOS_TID_GET(q_id));
  477. hal_tx_desc_set_flow_override_enable(hal_tx_desc_cached,
  478. DP_TX_FLOW_OVERRIDE_ENABLE);
  479. hal_tx_desc_set_flow_override(hal_tx_desc_cached,
  480. DP_TX_FLOW_OVERRIDE_GET(q_id));
  481. hal_tx_desc_set_who_classify_info_sel(hal_tx_desc_cached,
  482. DP_TX_WHO_CLFY_INF_SEL_GET(q_id));
  483. }
  484. #else
  485. static inline
  486. void dp_sawf_config_be(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  487. uint16_t *fw_metadata, qdf_nbuf_t nbuf)
  488. {
  489. }
  490. static inline
  491. QDF_STATUS dp_sawf_tx_enqueue_peer_stats(struct dp_soc *soc,
  492. struct dp_tx_desc_s *tx_desc)
  493. {
  494. return QDF_STATUS_SUCCESS;
  495. }
  496. static inline
  497. QDF_STATUS dp_sawf_tx_enqueue_fail_peer_stats(struct dp_soc *soc,
  498. struct dp_tx_desc_s *tx_desc)
  499. {
  500. return QDF_STATUS_SUCCESS;
  501. }
  502. #endif
  503. QDF_STATUS
  504. dp_tx_hw_enqueue_be(struct dp_soc *soc, struct dp_vdev *vdev,
  505. struct dp_tx_desc_s *tx_desc, uint16_t fw_metadata,
  506. struct cdp_tx_exception_metadata *tx_exc_metadata,
  507. struct dp_tx_msdu_info_s *msdu_info)
  508. {
  509. void *hal_tx_desc;
  510. uint32_t *hal_tx_desc_cached;
  511. int coalesce = 0;
  512. struct dp_tx_queue *tx_q = &msdu_info->tx_queue;
  513. uint8_t ring_id = tx_q->ring_id;
  514. uint8_t tid = msdu_info->tid;
  515. struct dp_vdev_be *be_vdev;
  516. uint8_t cached_desc[HAL_TX_DESC_LEN_BYTES] = { 0 };
  517. uint8_t bm_id = dp_tx_get_rbm_id_be(soc, ring_id);
  518. hal_ring_handle_t hal_ring_hdl = NULL;
  519. QDF_STATUS status = QDF_STATUS_E_RESOURCES;
  520. be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  521. if (!dp_tx_is_desc_id_valid(soc, tx_desc->id)) {
  522. dp_err_rl("Invalid tx desc id:%d", tx_desc->id);
  523. return QDF_STATUS_E_RESOURCES;
  524. }
  525. if (qdf_unlikely(tx_exc_metadata)) {
  526. qdf_assert_always((tx_exc_metadata->tx_encap_type ==
  527. CDP_INVALID_TX_ENCAP_TYPE) ||
  528. (tx_exc_metadata->tx_encap_type ==
  529. vdev->tx_encap_type));
  530. if (tx_exc_metadata->tx_encap_type == htt_cmn_pkt_type_raw)
  531. qdf_assert_always((tx_exc_metadata->sec_type ==
  532. CDP_INVALID_SEC_TYPE) ||
  533. tx_exc_metadata->sec_type ==
  534. vdev->sec_type);
  535. }
  536. hal_tx_desc_cached = (void *)cached_desc;
  537. if (dp_sawf_tag_valid_get(tx_desc->nbuf)) {
  538. dp_sawf_config_be(soc, hal_tx_desc_cached,
  539. &fw_metadata, tx_desc->nbuf);
  540. dp_sawf_tx_enqueue_peer_stats(soc, tx_desc);
  541. }
  542. hal_tx_desc_set_buf_addr_be(soc->hal_soc, hal_tx_desc_cached,
  543. tx_desc->dma_addr, bm_id, tx_desc->id,
  544. (tx_desc->flags & DP_TX_DESC_FLAG_FRAG));
  545. hal_tx_desc_set_lmac_id_be(soc->hal_soc, hal_tx_desc_cached,
  546. vdev->lmac_id);
  547. hal_tx_desc_set_search_index_be(soc->hal_soc, hal_tx_desc_cached,
  548. vdev->bss_ast_idx);
  549. /*
  550. * Bank_ID is used as DSCP_TABLE number in beryllium
  551. * So there is no explicit field used for DSCP_TID_TABLE_NUM.
  552. */
  553. hal_tx_desc_set_cache_set_num(soc->hal_soc, hal_tx_desc_cached,
  554. (vdev->bss_ast_hash & 0xF));
  555. hal_tx_desc_set_fw_metadata(hal_tx_desc_cached, fw_metadata);
  556. hal_tx_desc_set_buf_length(hal_tx_desc_cached, tx_desc->length);
  557. hal_tx_desc_set_buf_offset(hal_tx_desc_cached, tx_desc->pkt_offset);
  558. if (tx_desc->flags & DP_TX_DESC_FLAG_TO_FW)
  559. hal_tx_desc_set_to_fw(hal_tx_desc_cached, 1);
  560. /* verify checksum offload configuration*/
  561. if ((qdf_nbuf_get_tx_cksum(tx_desc->nbuf) ==
  562. QDF_NBUF_TX_CKSUM_TCP_UDP) ||
  563. qdf_nbuf_is_tso(tx_desc->nbuf)) {
  564. hal_tx_desc_set_l3_checksum_en(hal_tx_desc_cached, 1);
  565. hal_tx_desc_set_l4_checksum_en(hal_tx_desc_cached, 1);
  566. }
  567. hal_tx_desc_set_bank_id(hal_tx_desc_cached, be_vdev->bank_id);
  568. dp_tx_vdev_id_set_hal_tx_desc(hal_tx_desc_cached, vdev, msdu_info);
  569. if (tid != HTT_TX_EXT_TID_INVALID)
  570. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached, tid);
  571. dp_tx_set_min_rates_for_critical_frames(soc, hal_tx_desc_cached,
  572. tx_desc->nbuf);
  573. dp_tx_desc_set_ktimestamp(vdev, tx_desc);
  574. hal_ring_hdl = dp_tx_get_hal_ring_hdl(soc, ring_id);
  575. if (qdf_unlikely(dp_tx_hal_ring_access_start(soc, hal_ring_hdl))) {
  576. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  577. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  578. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  579. dp_sawf_tx_enqueue_fail_peer_stats(soc, tx_desc);
  580. return status;
  581. }
  582. hal_tx_desc = hal_srng_src_get_next(soc->hal_soc, hal_ring_hdl);
  583. if (qdf_unlikely(!hal_tx_desc)) {
  584. dp_verbose_debug("TCL ring full ring_id:%d", ring_id);
  585. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  586. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  587. dp_sawf_tx_enqueue_fail_peer_stats(soc, tx_desc);
  588. goto ring_access_fail;
  589. }
  590. tx_desc->flags |= DP_TX_DESC_FLAG_QUEUED_TX;
  591. dp_vdev_peer_stats_update_protocol_cnt_tx(vdev, tx_desc->nbuf);
  592. /* Sync cached descriptor with HW */
  593. hal_tx_desc_sync(hal_tx_desc_cached, hal_tx_desc);
  594. coalesce = dp_tx_attempt_coalescing(soc, vdev, tx_desc, tid,
  595. msdu_info, ring_id);
  596. DP_STATS_INC_PKT(vdev, tx_i.processed, 1, tx_desc->length);
  597. DP_STATS_INC(soc, tx.tcl_enq[ring_id], 1);
  598. dp_tx_update_stats(soc, tx_desc, ring_id);
  599. status = QDF_STATUS_SUCCESS;
  600. dp_tx_hw_desc_update_evt((uint8_t *)hal_tx_desc_cached,
  601. hal_ring_hdl, soc);
  602. ring_access_fail:
  603. dp_tx_ring_access_end_wrapper(soc, hal_ring_hdl, coalesce);
  604. return status;
  605. }
  606. QDF_STATUS dp_tx_init_bank_profiles(struct dp_soc_be *be_soc)
  607. {
  608. int i, num_tcl_banks;
  609. num_tcl_banks = hal_tx_get_num_tcl_banks(be_soc->soc.hal_soc);
  610. qdf_assert_always(num_tcl_banks);
  611. be_soc->num_bank_profiles = num_tcl_banks;
  612. be_soc->bank_profiles = qdf_mem_malloc(num_tcl_banks *
  613. sizeof(*be_soc->bank_profiles));
  614. if (!be_soc->bank_profiles) {
  615. dp_err("unable to allocate memory for DP TX Profiles!");
  616. return QDF_STATUS_E_NOMEM;
  617. }
  618. DP_TX_BANK_LOCK_CREATE(&be_soc->tx_bank_lock);
  619. for (i = 0; i < num_tcl_banks; i++) {
  620. be_soc->bank_profiles[i].is_configured = false;
  621. qdf_atomic_init(&be_soc->bank_profiles[i].ref_count);
  622. }
  623. dp_info("initialized %u bank profiles", be_soc->num_bank_profiles);
  624. return QDF_STATUS_SUCCESS;
  625. }
  626. void dp_tx_deinit_bank_profiles(struct dp_soc_be *be_soc)
  627. {
  628. qdf_mem_free(be_soc->bank_profiles);
  629. DP_TX_BANK_LOCK_DESTROY(&be_soc->tx_bank_lock);
  630. }
  631. static
  632. void dp_tx_get_vdev_bank_config(struct dp_vdev_be *be_vdev,
  633. union hal_tx_bank_config *bank_config)
  634. {
  635. struct dp_vdev *vdev = &be_vdev->vdev;
  636. bank_config->epd = 0;
  637. bank_config->encap_type = vdev->tx_encap_type;
  638. /* Only valid for raw frames. Needs work for RAW mode */
  639. if (vdev->tx_encap_type == htt_cmn_pkt_type_raw) {
  640. bank_config->encrypt_type = sec_type_map[vdev->sec_type];
  641. } else {
  642. bank_config->encrypt_type = 0;
  643. }
  644. bank_config->src_buffer_swap = 0;
  645. bank_config->link_meta_swap = 0;
  646. if ((vdev->search_type == HAL_TX_ADDR_INDEX_SEARCH) &&
  647. vdev->opmode == wlan_op_mode_sta) {
  648. bank_config->index_lookup_enable = 1;
  649. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_MEC_NOTIFY;
  650. bank_config->addrx_en = 0;
  651. bank_config->addry_en = 0;
  652. } else {
  653. bank_config->index_lookup_enable = 0;
  654. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_FW_EXCEPTION;
  655. bank_config->addrx_en =
  656. (vdev->hal_desc_addr_search_flags &
  657. HAL_TX_DESC_ADDRX_EN) ? 1 : 0;
  658. bank_config->addry_en =
  659. (vdev->hal_desc_addr_search_flags &
  660. HAL_TX_DESC_ADDRY_EN) ? 1 : 0;
  661. }
  662. bank_config->mesh_enable = vdev->mesh_vdev ? 1 : 0;
  663. bank_config->dscp_tid_map_id = vdev->dscp_tid_map_id;
  664. /* Disabling vdev id check for now. Needs revist. */
  665. bank_config->vdev_id_check_en = be_vdev->vdev_id_check_en;
  666. bank_config->pmac_id = vdev->lmac_id;
  667. }
  668. int dp_tx_get_bank_profile(struct dp_soc_be *be_soc,
  669. struct dp_vdev_be *be_vdev)
  670. {
  671. char *temp_str = "";
  672. bool found_match = false;
  673. int bank_id = DP_BE_INVALID_BANK_ID;
  674. int i;
  675. int unconfigured_slot = DP_BE_INVALID_BANK_ID;
  676. int zero_ref_count_slot = DP_BE_INVALID_BANK_ID;
  677. union hal_tx_bank_config vdev_config = {0};
  678. /* convert vdev params into hal_tx_bank_config */
  679. dp_tx_get_vdev_bank_config(be_vdev, &vdev_config);
  680. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  681. /* go over all banks and find a matching/unconfigured/unsed bank */
  682. for (i = 0; i < be_soc->num_bank_profiles; i++) {
  683. if (be_soc->bank_profiles[i].is_configured &&
  684. (be_soc->bank_profiles[i].bank_config.val ^
  685. vdev_config.val) == 0) {
  686. found_match = true;
  687. break;
  688. }
  689. if (unconfigured_slot == DP_BE_INVALID_BANK_ID &&
  690. !be_soc->bank_profiles[i].is_configured)
  691. unconfigured_slot = i;
  692. else if (zero_ref_count_slot == DP_BE_INVALID_BANK_ID &&
  693. !qdf_atomic_read(&be_soc->bank_profiles[i].ref_count))
  694. zero_ref_count_slot = i;
  695. }
  696. if (found_match) {
  697. temp_str = "matching";
  698. bank_id = i;
  699. goto inc_ref_and_return;
  700. }
  701. if (unconfigured_slot != DP_BE_INVALID_BANK_ID) {
  702. temp_str = "unconfigured";
  703. bank_id = unconfigured_slot;
  704. goto configure_and_return;
  705. }
  706. if (zero_ref_count_slot != DP_BE_INVALID_BANK_ID) {
  707. temp_str = "zero_ref_count";
  708. bank_id = zero_ref_count_slot;
  709. }
  710. if (bank_id == DP_BE_INVALID_BANK_ID) {
  711. dp_alert("unable to find TX bank!");
  712. QDF_BUG(0);
  713. return bank_id;
  714. }
  715. configure_and_return:
  716. be_soc->bank_profiles[bank_id].is_configured = true;
  717. be_soc->bank_profiles[bank_id].bank_config.val = vdev_config.val;
  718. hal_tx_populate_bank_register(be_soc->soc.hal_soc,
  719. &be_soc->bank_profiles[bank_id].bank_config,
  720. bank_id);
  721. inc_ref_and_return:
  722. qdf_atomic_inc(&be_soc->bank_profiles[bank_id].ref_count);
  723. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  724. dp_info("found %s slot at index %d, input:0x%x match:0x%x ref_count %u",
  725. temp_str, bank_id, vdev_config.val,
  726. be_soc->bank_profiles[bank_id].bank_config.val,
  727. qdf_atomic_read(&be_soc->bank_profiles[bank_id].ref_count));
  728. 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",
  729. be_soc->bank_profiles[bank_id].bank_config.epd,
  730. be_soc->bank_profiles[bank_id].bank_config.encap_type,
  731. be_soc->bank_profiles[bank_id].bank_config.encrypt_type,
  732. be_soc->bank_profiles[bank_id].bank_config.src_buffer_swap,
  733. be_soc->bank_profiles[bank_id].bank_config.link_meta_swap,
  734. be_soc->bank_profiles[bank_id].bank_config.addrx_en,
  735. be_soc->bank_profiles[bank_id].bank_config.addry_en,
  736. be_soc->bank_profiles[bank_id].bank_config.mesh_enable,
  737. be_soc->bank_profiles[bank_id].bank_config.vdev_id_check_en,
  738. be_soc->bank_profiles[bank_id].bank_config.pmac_id,
  739. be_soc->bank_profiles[bank_id].bank_config.mcast_pkt_ctrl);
  740. return bank_id;
  741. }
  742. void dp_tx_put_bank_profile(struct dp_soc_be *be_soc,
  743. struct dp_vdev_be *be_vdev)
  744. {
  745. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  746. qdf_atomic_dec(&be_soc->bank_profiles[be_vdev->bank_id].ref_count);
  747. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  748. }
  749. void dp_tx_update_bank_profile(struct dp_soc_be *be_soc,
  750. struct dp_vdev_be *be_vdev)
  751. {
  752. dp_tx_put_bank_profile(be_soc, be_vdev);
  753. be_vdev->bank_id = dp_tx_get_bank_profile(be_soc, be_vdev);
  754. }
  755. QDF_STATUS dp_tx_desc_pool_init_be(struct dp_soc *soc,
  756. uint32_t num_elem,
  757. uint8_t pool_id)
  758. {
  759. struct dp_tx_desc_pool_s *tx_desc_pool;
  760. struct dp_hw_cookie_conversion_t *cc_ctx;
  761. struct dp_soc_be *be_soc;
  762. struct dp_spt_page_desc *page_desc;
  763. struct dp_tx_desc_s *tx_desc;
  764. uint32_t ppt_idx = 0;
  765. uint32_t avail_entry_index = 0;
  766. if (!num_elem) {
  767. dp_err("desc_num 0 !!");
  768. return QDF_STATUS_E_FAILURE;
  769. }
  770. be_soc = dp_get_be_soc_from_dp_soc(soc);
  771. tx_desc_pool = &soc->tx_desc[pool_id];
  772. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  773. tx_desc = tx_desc_pool->freelist;
  774. page_desc = &cc_ctx->page_desc_base[0];
  775. while (tx_desc) {
  776. if (avail_entry_index == 0) {
  777. if (ppt_idx >= cc_ctx->total_page_num) {
  778. dp_alert("insufficient secondary page tables");
  779. qdf_assert_always(0);
  780. }
  781. page_desc = &cc_ctx->page_desc_base[ppt_idx++];
  782. }
  783. /* put each TX Desc VA to SPT pages and
  784. * get corresponding ID
  785. */
  786. DP_CC_SPT_PAGE_UPDATE_VA(page_desc->page_v_addr,
  787. avail_entry_index,
  788. tx_desc);
  789. tx_desc->id =
  790. dp_cc_desc_id_generate(page_desc->ppt_index,
  791. avail_entry_index);
  792. tx_desc->pool_id = pool_id;
  793. dp_tx_desc_set_magic(tx_desc, DP_TX_MAGIC_PATTERN_FREE);
  794. tx_desc = tx_desc->next;
  795. avail_entry_index = (avail_entry_index + 1) &
  796. DP_CC_SPT_PAGE_MAX_ENTRIES_MASK;
  797. }
  798. return QDF_STATUS_SUCCESS;
  799. }
  800. void dp_tx_desc_pool_deinit_be(struct dp_soc *soc,
  801. struct dp_tx_desc_pool_s *tx_desc_pool,
  802. uint8_t pool_id)
  803. {
  804. struct dp_spt_page_desc *page_desc;
  805. struct dp_soc_be *be_soc;
  806. int i = 0;
  807. struct dp_hw_cookie_conversion_t *cc_ctx;
  808. be_soc = dp_get_be_soc_from_dp_soc(soc);
  809. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  810. for (i = 0; i < cc_ctx->total_page_num; i++) {
  811. page_desc = &cc_ctx->page_desc_base[i];
  812. qdf_mem_zero(page_desc->page_v_addr, qdf_page_size);
  813. }
  814. }
  815. #ifdef WLAN_FEATURE_NEAR_FULL_IRQ
  816. uint32_t dp_tx_comp_nf_handler(struct dp_intr *int_ctx, struct dp_soc *soc,
  817. hal_ring_handle_t hal_ring_hdl, uint8_t ring_id,
  818. uint32_t quota)
  819. {
  820. struct dp_srng *tx_comp_ring = &soc->tx_comp_ring[ring_id];
  821. uint32_t work_done = 0;
  822. if (dp_srng_get_near_full_level(soc, tx_comp_ring) <
  823. DP_SRNG_THRESH_NEAR_FULL)
  824. return 0;
  825. qdf_atomic_set(&tx_comp_ring->near_full, 1);
  826. work_done++;
  827. return work_done;
  828. }
  829. #endif
  830. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  831. defined(CONFIG_SAWF)
  832. #define PPDUID_GET_HW_LINK_ID(PPDU_ID, LINK_ID_OFFSET, LINK_ID_BITS) \
  833. (((PPDU_ID) >> (LINK_ID_OFFSET)) & ((1 << (LINK_ID_BITS)) - 1))
  834. #define HW_TX_DELAY_MAX 0x1000000
  835. #define TX_COMPL_SHIFT_BUFFER_TIMESTAMP_US 10
  836. #define HW_TX_DELAY_MASK 0x1FFFFFFF
  837. #define TX_COMPL_BUFFER_TSTAMP_US(TSTAMP) \
  838. (((TSTAMP) << TX_COMPL_SHIFT_BUFFER_TIMESTAMP_US) & \
  839. HW_TX_DELAY_MASK)
  840. static inline
  841. QDF_STATUS dp_mlo_compute_hw_delay_us(struct dp_soc *soc,
  842. struct dp_vdev *vdev,
  843. struct hal_tx_completion_status *ts,
  844. uint32_t *delay_us)
  845. {
  846. uint32_t ppdu_id;
  847. uint8_t link_id_offset, link_id_bits;
  848. uint8_t hw_link_id;
  849. uint32_t msdu_tqm_enqueue_tstamp_us, final_msdu_tqm_enqueue_tstamp_us;
  850. uint32_t msdu_compl_tsf_tstamp_us, final_msdu_compl_tsf_tstamp_us;
  851. uint32_t delay;
  852. int32_t delta_tsf2, delta_tqm;
  853. if (!ts->valid)
  854. return QDF_STATUS_E_INVAL;
  855. link_id_offset = soc->link_id_offset;
  856. link_id_bits = soc->link_id_bits;
  857. ppdu_id = ts->ppdu_id;
  858. hw_link_id = PPDUID_GET_HW_LINK_ID(ppdu_id, link_id_offset,
  859. link_id_bits);
  860. msdu_tqm_enqueue_tstamp_us =
  861. TX_COMPL_BUFFER_TSTAMP_US(ts->buffer_timestamp);
  862. msdu_compl_tsf_tstamp_us = ts->tsf;
  863. delta_tsf2 = dp_mlo_get_delta_tsf2_wrt_mlo_offset(soc, hw_link_id);
  864. delta_tqm = dp_mlo_get_delta_tqm_wrt_mlo_offset(soc);
  865. final_msdu_tqm_enqueue_tstamp_us = (msdu_tqm_enqueue_tstamp_us +
  866. delta_tqm) & HW_TX_DELAY_MASK;
  867. final_msdu_compl_tsf_tstamp_us = (msdu_compl_tsf_tstamp_us +
  868. delta_tsf2) & HW_TX_DELAY_MASK;
  869. delay = (final_msdu_compl_tsf_tstamp_us -
  870. final_msdu_tqm_enqueue_tstamp_us) & HW_TX_DELAY_MASK;
  871. if (delay > HW_TX_DELAY_MAX)
  872. return QDF_STATUS_E_FAILURE;
  873. if (delay_us)
  874. *delay_us = delay;
  875. return QDF_STATUS_SUCCESS;
  876. }
  877. #else
  878. static inline
  879. QDF_STATUS dp_mlo_compute_hw_delay_us(struct dp_soc *soc,
  880. struct dp_vdev *vdev,
  881. struct hal_tx_completion_status *ts,
  882. uint32_t *delay_us)
  883. {
  884. return QDF_STATUS_SUCCESS;
  885. }
  886. #endif
  887. QDF_STATUS dp_tx_compute_tx_delay_be(struct dp_soc *soc,
  888. struct dp_vdev *vdev,
  889. struct hal_tx_completion_status *ts,
  890. uint32_t *delay_us)
  891. {
  892. return dp_mlo_compute_hw_delay_us(soc, vdev, ts, delay_us);
  893. }