dp_be_tx.c 48 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699
  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. #ifdef QCA_MULTIPASS_SUPPORT
  48. #define INVALID_VLAN_ID 0xFFFF
  49. #define MULTIPASS_WITH_VLAN_ID 0xFFFE
  50. /**
  51. * struct dp_mlo_mpass_buf - Multipass buffer
  52. * @vlan_id: vlan_id of frame
  53. * @nbuf: pointer to skb buf
  54. */
  55. struct dp_mlo_mpass_buf {
  56. uint16_t vlan_id;
  57. qdf_nbuf_t nbuf;
  58. };
  59. #endif
  60. #endif
  61. #endif
  62. #define DP_TX_WBM_COMPLETION_V3_VDEV_ID_GET(_var) \
  63. HTT_TX_WBM_COMPLETION_V2_VDEV_ID_GET(_var)
  64. #define DP_TX_WBM_COMPLETION_V3_VALID_GET(_var) \
  65. HTT_TX_WBM_COMPLETION_V2_VALID_GET(_var)
  66. #define DP_TX_WBM_COMPLETION_V3_SW_PEER_ID_GET(_var) \
  67. HTT_TX_WBM_COMPLETION_V2_SW_PEER_ID_GET(_var)
  68. #define DP_TX_WBM_COMPLETION_V3_TID_NUM_GET(_var) \
  69. HTT_TX_WBM_COMPLETION_V2_TID_NUM_GET(_var)
  70. #define DP_TX_WBM_COMPLETION_V3_SCH_CMD_ID_GET(_var) \
  71. HTT_TX_WBM_COMPLETION_V2_SCH_CMD_ID_GET(_var)
  72. #define DP_TX_WBM_COMPLETION_V3_ACK_FRAME_RSSI_GET(_var) \
  73. HTT_TX_WBM_COMPLETION_V2_ACK_FRAME_RSSI_GET(_var)
  74. extern uint8_t sec_type_map[MAX_CDP_SEC_TYPE];
  75. #ifdef DP_TX_COMP_RING_DESC_SANITY_CHECK
  76. /*
  77. * Value to mark ring desc is invalidated by buffer_virt_addr_63_32 field
  78. * of WBM2SW ring Desc.
  79. */
  80. #define DP_TX_COMP_DESC_BUFF_VA_32BITS_HI_INVALIDATE 0x12121212
  81. /**
  82. * dp_tx_comp_desc_check_and_invalidate() - sanity check for ring desc and
  83. * invalidate it after each reaping
  84. * @tx_comp_hal_desc: ring desc virtual address
  85. * @r_tx_desc: pointer to current dp TX Desc pointer
  86. * @tx_desc_va: the original 64 bits Desc VA got from ring Desc
  87. * @hw_cc_done: HW cookie conversion done or not
  88. *
  89. * If HW CC is done, check the buffer_virt_addr_63_32 value to know if
  90. * ring Desc is stale or not. if HW CC is not done, then compare PA between
  91. * ring Desc and current TX desc.
  92. *
  93. * Return: None.
  94. */
  95. static inline
  96. void dp_tx_comp_desc_check_and_invalidate(void *tx_comp_hal_desc,
  97. struct dp_tx_desc_s **r_tx_desc,
  98. uint64_t tx_desc_va,
  99. bool hw_cc_done)
  100. {
  101. qdf_dma_addr_t desc_dma_addr;
  102. if (qdf_likely(hw_cc_done)) {
  103. /* Check upper 32 bits */
  104. if (DP_TX_COMP_DESC_BUFF_VA_32BITS_HI_INVALIDATE ==
  105. (tx_desc_va >> 32))
  106. *r_tx_desc = NULL;
  107. /* Invalidate the ring desc for 32 ~ 63 bits of VA */
  108. hal_tx_comp_set_desc_va_63_32(
  109. tx_comp_hal_desc,
  110. DP_TX_COMP_DESC_BUFF_VA_32BITS_HI_INVALIDATE);
  111. } else {
  112. /* Compare PA between ring desc and current TX desc stored */
  113. desc_dma_addr = hal_tx_comp_get_paddr(tx_comp_hal_desc);
  114. if (desc_dma_addr != (*r_tx_desc)->dma_addr)
  115. *r_tx_desc = NULL;
  116. }
  117. }
  118. #else
  119. static inline
  120. void dp_tx_comp_desc_check_and_invalidate(void *tx_comp_hal_desc,
  121. struct dp_tx_desc_s **r_tx_desc,
  122. uint64_t tx_desc_va,
  123. bool hw_cc_done)
  124. {
  125. }
  126. #endif
  127. #ifdef DP_FEATURE_HW_COOKIE_CONVERSION
  128. #ifdef DP_HW_COOKIE_CONVERT_EXCEPTION
  129. void dp_tx_comp_get_params_from_hal_desc_be(struct dp_soc *soc,
  130. void *tx_comp_hal_desc,
  131. struct dp_tx_desc_s **r_tx_desc)
  132. {
  133. uint32_t tx_desc_id;
  134. uint64_t tx_desc_va = 0;
  135. bool hw_cc_done =
  136. hal_tx_comp_get_cookie_convert_done(tx_comp_hal_desc);
  137. if (qdf_likely(hw_cc_done)) {
  138. /* HW cookie conversion done */
  139. tx_desc_va = hal_tx_comp_get_desc_va(tx_comp_hal_desc);
  140. *r_tx_desc = (struct dp_tx_desc_s *)(uintptr_t)tx_desc_va;
  141. } else {
  142. /* SW do cookie conversion to VA */
  143. tx_desc_id = hal_tx_comp_get_desc_id(tx_comp_hal_desc);
  144. *r_tx_desc =
  145. (struct dp_tx_desc_s *)dp_cc_desc_find(soc, tx_desc_id);
  146. }
  147. dp_tx_comp_desc_check_and_invalidate(tx_comp_hal_desc,
  148. r_tx_desc, tx_desc_va,
  149. hw_cc_done);
  150. if (*r_tx_desc)
  151. (*r_tx_desc)->peer_id =
  152. dp_tx_comp_get_peer_id_be(soc,
  153. tx_comp_hal_desc);
  154. }
  155. #else
  156. void dp_tx_comp_get_params_from_hal_desc_be(struct dp_soc *soc,
  157. void *tx_comp_hal_desc,
  158. struct dp_tx_desc_s **r_tx_desc)
  159. {
  160. uint64_t tx_desc_va;
  161. tx_desc_va = hal_tx_comp_get_desc_va(tx_comp_hal_desc);
  162. *r_tx_desc = (struct dp_tx_desc_s *)(uintptr_t)tx_desc_va;
  163. dp_tx_comp_desc_check_and_invalidate(tx_comp_hal_desc,
  164. r_tx_desc,
  165. tx_desc_va,
  166. true);
  167. if (*r_tx_desc)
  168. (*r_tx_desc)->peer_id =
  169. dp_tx_comp_get_peer_id_be(soc,
  170. tx_comp_hal_desc);
  171. }
  172. #endif /* DP_HW_COOKIE_CONVERT_EXCEPTION */
  173. #else
  174. void dp_tx_comp_get_params_from_hal_desc_be(struct dp_soc *soc,
  175. void *tx_comp_hal_desc,
  176. struct dp_tx_desc_s **r_tx_desc)
  177. {
  178. uint32_t tx_desc_id;
  179. /* SW do cookie conversion to VA */
  180. tx_desc_id = hal_tx_comp_get_desc_id(tx_comp_hal_desc);
  181. *r_tx_desc =
  182. (struct dp_tx_desc_s *)dp_cc_desc_find(soc, tx_desc_id);
  183. dp_tx_comp_desc_check_and_invalidate(tx_comp_hal_desc,
  184. r_tx_desc, 0,
  185. false);
  186. if (*r_tx_desc)
  187. (*r_tx_desc)->peer_id =
  188. dp_tx_comp_get_peer_id_be(soc,
  189. tx_comp_hal_desc);
  190. }
  191. #endif /* DP_FEATURE_HW_COOKIE_CONVERSION */
  192. static inline
  193. void dp_tx_process_mec_notify_be(struct dp_soc *soc, uint8_t *status)
  194. {
  195. struct dp_vdev *vdev;
  196. uint8_t vdev_id;
  197. uint32_t *htt_desc = (uint32_t *)status;
  198. qdf_assert_always(!soc->mec_fw_offload);
  199. /*
  200. * Get vdev id from HTT status word in case of MEC
  201. * notification
  202. */
  203. vdev_id = DP_TX_WBM_COMPLETION_V3_VDEV_ID_GET(htt_desc[4]);
  204. if (qdf_unlikely(vdev_id >= MAX_VDEV_CNT))
  205. return;
  206. vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  207. DP_MOD_ID_HTT_COMP);
  208. if (!vdev)
  209. return;
  210. dp_tx_mec_handler(vdev, status);
  211. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  212. }
  213. void dp_tx_process_htt_completion_be(struct dp_soc *soc,
  214. struct dp_tx_desc_s *tx_desc,
  215. uint8_t *status,
  216. uint8_t ring_id)
  217. {
  218. uint8_t tx_status;
  219. struct dp_pdev *pdev;
  220. struct dp_vdev *vdev = NULL;
  221. struct hal_tx_completion_status ts = {0};
  222. uint32_t *htt_desc = (uint32_t *)status;
  223. struct dp_txrx_peer *txrx_peer;
  224. dp_txrx_ref_handle txrx_ref_handle = NULL;
  225. struct cdp_tid_tx_stats *tid_stats = NULL;
  226. struct htt_soc *htt_handle;
  227. uint8_t vdev_id;
  228. tx_status = HTT_TX_WBM_COMPLETION_V3_TX_STATUS_GET(htt_desc[0]);
  229. htt_handle = (struct htt_soc *)soc->htt_handle;
  230. htt_wbm_event_record(htt_handle->htt_logger_handle, tx_status, status);
  231. /*
  232. * There can be scenario where WBM consuming descriptor enqueued
  233. * from TQM2WBM first and TQM completion can happen before MEC
  234. * notification comes from FW2WBM. Avoid access any field of tx
  235. * descriptor in case of MEC notify.
  236. */
  237. if (tx_status == HTT_TX_FW2WBM_TX_STATUS_MEC_NOTIFY)
  238. return dp_tx_process_mec_notify_be(soc, status);
  239. /*
  240. * If the descriptor is already freed in vdev_detach,
  241. * continue to next descriptor
  242. */
  243. if (qdf_unlikely(!tx_desc->flags)) {
  244. dp_tx_comp_info_rl("Descriptor freed in vdev_detach %d",
  245. tx_desc->id);
  246. return;
  247. }
  248. if (qdf_unlikely(tx_desc->vdev_id == DP_INVALID_VDEV_ID)) {
  249. dp_tx_comp_info_rl("Invalid vdev_id %d", tx_desc->id);
  250. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  251. goto release_tx_desc;
  252. }
  253. pdev = tx_desc->pdev;
  254. if (qdf_unlikely(tx_desc->pdev->is_pdev_down)) {
  255. dp_tx_comp_info_rl("pdev in down state %d", tx_desc->id);
  256. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  257. goto release_tx_desc;
  258. }
  259. qdf_assert(tx_desc->pdev);
  260. vdev_id = tx_desc->vdev_id;
  261. vdev = dp_vdev_get_ref_by_id(soc, vdev_id,
  262. DP_MOD_ID_HTT_COMP);
  263. if (qdf_unlikely(!vdev)) {
  264. dp_tx_comp_info_rl("Unable to get vdev ref %d", tx_desc->id);
  265. tx_desc->flags |= DP_TX_DESC_FLAG_TX_COMP_ERR;
  266. goto release_tx_desc;
  267. }
  268. switch (tx_status) {
  269. case HTT_TX_FW2WBM_TX_STATUS_OK:
  270. case HTT_TX_FW2WBM_TX_STATUS_DROP:
  271. case HTT_TX_FW2WBM_TX_STATUS_TTL:
  272. {
  273. uint8_t tid;
  274. if (DP_TX_WBM_COMPLETION_V3_VALID_GET(htt_desc[3])) {
  275. ts.peer_id =
  276. DP_TX_WBM_COMPLETION_V3_SW_PEER_ID_GET(
  277. htt_desc[3]);
  278. ts.tid =
  279. DP_TX_WBM_COMPLETION_V3_TID_NUM_GET(
  280. htt_desc[3]);
  281. } else {
  282. ts.peer_id = HTT_INVALID_PEER;
  283. ts.tid = HTT_INVALID_TID;
  284. }
  285. ts.release_src = HAL_TX_COMP_RELEASE_SOURCE_FW;
  286. ts.ppdu_id =
  287. DP_TX_WBM_COMPLETION_V3_SCH_CMD_ID_GET(
  288. htt_desc[2]);
  289. ts.ack_frame_rssi =
  290. DP_TX_WBM_COMPLETION_V3_ACK_FRAME_RSSI_GET(
  291. htt_desc[2]);
  292. ts.tsf = htt_desc[4];
  293. ts.first_msdu = 1;
  294. ts.last_msdu = 1;
  295. switch (tx_status) {
  296. case HTT_TX_FW2WBM_TX_STATUS_OK:
  297. ts.status = HAL_TX_TQM_RR_FRAME_ACKED;
  298. break;
  299. case HTT_TX_FW2WBM_TX_STATUS_DROP:
  300. ts.status = HAL_TX_TQM_RR_REM_CMD_REM;
  301. break;
  302. case HTT_TX_FW2WBM_TX_STATUS_TTL:
  303. ts.status = HAL_TX_TQM_RR_REM_CMD_TX;
  304. break;
  305. }
  306. tid = ts.tid;
  307. if (qdf_unlikely(tid >= CDP_MAX_DATA_TIDS))
  308. tid = CDP_MAX_DATA_TIDS - 1;
  309. tid_stats = &pdev->stats.tid_stats.tid_tx_stats[ring_id][tid];
  310. if (qdf_unlikely(pdev->delay_stats_flag) ||
  311. qdf_unlikely(dp_is_vdev_tx_delay_stats_enabled(vdev)))
  312. dp_tx_compute_delay(vdev, tx_desc, tid, ring_id);
  313. if (tx_status < CDP_MAX_TX_HTT_STATUS)
  314. tid_stats->htt_status_cnt[tx_status]++;
  315. txrx_peer = dp_txrx_peer_get_ref_by_id(soc, ts.peer_id,
  316. &txrx_ref_handle,
  317. DP_MOD_ID_HTT_COMP);
  318. if (qdf_likely(txrx_peer))
  319. dp_tx_update_peer_basic_stats(
  320. txrx_peer,
  321. qdf_nbuf_len(tx_desc->nbuf),
  322. tx_status,
  323. pdev->enhanced_stats_en);
  324. dp_tx_comp_process_tx_status(soc, tx_desc, &ts, txrx_peer,
  325. ring_id);
  326. dp_tx_comp_process_desc(soc, tx_desc, &ts, txrx_peer);
  327. dp_tx_desc_release(tx_desc, tx_desc->pool_id);
  328. if (qdf_likely(txrx_peer))
  329. dp_txrx_peer_unref_delete(txrx_ref_handle,
  330. DP_MOD_ID_HTT_COMP);
  331. break;
  332. }
  333. case HTT_TX_FW2WBM_TX_STATUS_REINJECT:
  334. {
  335. uint8_t reinject_reason;
  336. reinject_reason =
  337. HTT_TX_WBM_COMPLETION_V3_REINJECT_REASON_GET(
  338. htt_desc[1]);
  339. dp_tx_reinject_handler(soc, vdev, tx_desc,
  340. status, reinject_reason);
  341. break;
  342. }
  343. case HTT_TX_FW2WBM_TX_STATUS_INSPECT:
  344. {
  345. dp_tx_inspect_handler(soc, vdev, tx_desc, status);
  346. break;
  347. }
  348. case HTT_TX_FW2WBM_TX_STATUS_VDEVID_MISMATCH:
  349. {
  350. DP_STATS_INC(vdev, tx_i.dropped.fail_per_pkt_vdev_id_check, 1);
  351. goto release_tx_desc;
  352. }
  353. default:
  354. dp_tx_comp_err("Invalid HTT tx_status %d\n",
  355. tx_status);
  356. goto release_tx_desc;
  357. }
  358. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  359. return;
  360. release_tx_desc:
  361. dp_tx_comp_free_buf(soc, tx_desc, false);
  362. dp_tx_desc_release(tx_desc, tx_desc->pool_id);
  363. if (vdev)
  364. dp_vdev_unref_delete(soc, vdev, DP_MOD_ID_HTT_COMP);
  365. }
  366. #ifdef QCA_OL_TX_MULTIQ_SUPPORT
  367. #ifdef DP_TX_IMPLICIT_RBM_MAPPING
  368. /*
  369. * dp_tx_get_rbm_id()- Get the RBM ID for data transmission completion.
  370. * @dp_soc - DP soc structure pointer
  371. * @ring_id - Transmit Queue/ring_id to be used when XPS is enabled
  372. *
  373. * Return - RBM ID corresponding to TCL ring_id
  374. */
  375. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  376. uint8_t ring_id)
  377. {
  378. return 0;
  379. }
  380. #else
  381. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  382. uint8_t ring_id)
  383. {
  384. return (ring_id ? soc->wbm_sw0_bm_id + (ring_id - 1) :
  385. HAL_WBM_SW2_BM_ID(soc->wbm_sw0_bm_id));
  386. }
  387. #endif /*DP_TX_IMPLICIT_RBM_MAPPING*/
  388. #else
  389. static inline uint8_t dp_tx_get_rbm_id_be(struct dp_soc *soc,
  390. uint8_t tcl_index)
  391. {
  392. uint8_t rbm;
  393. rbm = wlan_cfg_get_rbm_id_for_index(soc->wlan_cfg_ctx, tcl_index);
  394. dp_verbose_debug("tcl_id %u rbm %u", tcl_index, rbm);
  395. return rbm;
  396. }
  397. #endif
  398. #ifdef QCA_SUPPORT_TX_MIN_RATES_FOR_SPECIAL_FRAMES
  399. /*
  400. * dp_tx_set_min_rates_for_critical_frames()- sets min-rates for critical pkts
  401. * @dp_soc - DP soc structure pointer
  402. * @hal_tx_desc - HAL descriptor where fields are set
  403. * nbuf - skb to be considered for min rates
  404. *
  405. * The function relies on upper layers to set QDF_NBUF_CB_TX_EXTRA_IS_CRITICAL
  406. * and uses it to determine if the frame is critical. For a critical frame,
  407. * flow override bits are set to classify the frame into HW's high priority
  408. * queue. The HW will pick pre-configured min rates for such packets.
  409. *
  410. * Return - None
  411. */
  412. static void
  413. dp_tx_set_min_rates_for_critical_frames(struct dp_soc *soc,
  414. uint32_t *hal_tx_desc,
  415. qdf_nbuf_t nbuf)
  416. {
  417. /*
  418. * Critical frames should be queued to the high priority queue for the TID on
  419. * on which they are sent out (for the concerned peer).
  420. * FW is using HTT_MSDU_Q_IDX 2 for HOL (high priority) queue.
  421. * htt_msdu_idx = (2 * who_classify_info_sel) + flow_override
  422. * Hence, using who_classify_info_sel = 1, flow_override = 0 to select
  423. * HOL queue.
  424. */
  425. if (QDF_NBUF_CB_TX_EXTRA_IS_CRITICAL(nbuf)) {
  426. hal_tx_desc_set_flow_override_enable(hal_tx_desc, 1);
  427. hal_tx_desc_set_flow_override(hal_tx_desc, 0);
  428. hal_tx_desc_set_who_classify_info_sel(hal_tx_desc, 1);
  429. hal_tx_desc_set_tx_notify_frame(hal_tx_desc,
  430. TX_SEMI_HARD_NOTIFY_E);
  431. }
  432. }
  433. #else
  434. static inline void
  435. dp_tx_set_min_rates_for_critical_frames(struct dp_soc *soc,
  436. uint32_t *hal_tx_desc_cached,
  437. qdf_nbuf_t nbuf)
  438. {
  439. }
  440. #endif
  441. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  442. defined(WLAN_MCAST_MLO)
  443. #ifdef QCA_MULTIPASS_SUPPORT
  444. /**
  445. * dp_tx_mlo_mcast_multipass_lookup() - lookup vlan_id in mpass peer list
  446. * @be_vdev: Handle to DP be_vdev structure
  447. * @ptnr_vdev: DP ptnr_vdev handle
  448. * @arg: pointer to dp_mlo_mpass_ buf
  449. *
  450. * Return: None
  451. */
  452. static void
  453. dp_tx_mlo_mcast_multipass_lookup(struct dp_vdev_be *be_vdev,
  454. struct dp_vdev *ptnr_vdev,
  455. void *arg)
  456. {
  457. struct dp_mlo_mpass_buf *ptr = (struct dp_mlo_mpass_buf *)arg;
  458. struct dp_txrx_peer *txrx_peer = NULL;
  459. struct vlan_ethhdr *veh = NULL;
  460. qdf_ether_header_t *eh = (qdf_ether_header_t *)qdf_nbuf_data(ptr->nbuf);
  461. uint16_t vlan_id = 0;
  462. bool not_vlan = ((ptnr_vdev->tx_encap_type == htt_cmn_pkt_type_raw) ||
  463. (htons(eh->ether_type) != ETH_P_8021Q));
  464. if (qdf_unlikely(not_vlan))
  465. return;
  466. veh = (struct vlan_ethhdr *)eh;
  467. vlan_id = (ntohs(veh->h_vlan_TCI) & VLAN_VID_MASK);
  468. qdf_spin_lock_bh(&ptnr_vdev->mpass_peer_mutex);
  469. TAILQ_FOREACH(txrx_peer, &ptnr_vdev->mpass_peer_list,
  470. mpass_peer_list_elem) {
  471. if (vlan_id == txrx_peer->vlan_id) {
  472. qdf_spin_unlock_bh(&ptnr_vdev->mpass_peer_mutex);
  473. ptr->vlan_id = vlan_id;
  474. return;
  475. }
  476. }
  477. qdf_spin_unlock_bh(&ptnr_vdev->mpass_peer_mutex);
  478. }
  479. /**
  480. * dp_tx_mlo_mcast_multipass_send() - send multipass MLO Mcast packets
  481. * @be_vdev: Handle to DP be_vdev structure
  482. * @ptnr_vdev: DP ptnr_vdev handle
  483. * @arg: pointer to dp_mlo_mpass_ buf
  484. *
  485. * Return: None
  486. */
  487. static void
  488. dp_tx_mlo_mcast_multipass_send(struct dp_vdev_be *be_vdev,
  489. struct dp_vdev *ptnr_vdev,
  490. void *arg)
  491. {
  492. struct dp_mlo_mpass_buf *ptr = (struct dp_mlo_mpass_buf *)arg;
  493. struct dp_tx_msdu_info_s msdu_info;
  494. struct dp_vdev_be *be_ptnr_vdev = NULL;
  495. qdf_nbuf_t nbuf_clone;
  496. uint16_t group_key = 0;
  497. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  498. if (be_vdev != be_ptnr_vdev) {
  499. nbuf_clone = qdf_nbuf_clone(ptr->nbuf);
  500. if (qdf_unlikely(!nbuf_clone)) {
  501. dp_tx_debug("nbuf clone failed");
  502. return;
  503. }
  504. } else {
  505. nbuf_clone = ptr->nbuf;
  506. }
  507. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  508. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  509. msdu_info.gsn = be_vdev->seq_num;
  510. be_ptnr_vdev->seq_num = be_vdev->seq_num;
  511. if (ptr->vlan_id == MULTIPASS_WITH_VLAN_ID) {
  512. msdu_info.tid = HTT_TX_EXT_TID_INVALID;
  513. HTT_TX_MSDU_EXT2_DESC_FLAG_VALID_KEY_FLAGS_SET(
  514. msdu_info.meta_data[0], 1);
  515. } else {
  516. /* return when vlan map is not initialized */
  517. if (!ptnr_vdev->iv_vlan_map)
  518. return;
  519. group_key = ptnr_vdev->iv_vlan_map[ptr->vlan_id];
  520. /*
  521. * If group key is not installed, drop the frame.
  522. */
  523. if (!group_key)
  524. return;
  525. dp_tx_remove_vlan_tag(ptnr_vdev, nbuf_clone);
  526. dp_tx_add_groupkey_metadata(ptnr_vdev, &msdu_info, group_key);
  527. msdu_info.exception_fw = 1;
  528. }
  529. nbuf_clone = dp_tx_send_msdu_single(
  530. ptnr_vdev,
  531. nbuf_clone,
  532. &msdu_info,
  533. DP_MLO_MCAST_REINJECT_PEER_ID,
  534. NULL);
  535. if (qdf_unlikely(nbuf_clone)) {
  536. dp_info("pkt send failed");
  537. qdf_nbuf_free(nbuf_clone);
  538. return;
  539. }
  540. }
  541. /**
  542. * dp_tx_mlo_mcast_multipass_handler - If frame needs multipass processing
  543. * @soc: DP soc handle
  544. * @vdev: DP vdev handle
  545. * @nbuf: nbuf to be enqueued
  546. *
  547. * Return: true if handling is done else false
  548. */
  549. static bool
  550. dp_tx_mlo_mcast_multipass_handler(struct dp_soc *soc,
  551. struct dp_vdev *vdev,
  552. qdf_nbuf_t nbuf)
  553. {
  554. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  555. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  556. qdf_nbuf_t nbuf_copy = NULL;
  557. struct dp_mlo_mpass_buf mpass_buf;
  558. memset(&mpass_buf, 0, sizeof(struct dp_mlo_mpass_buf));
  559. mpass_buf.vlan_id = INVALID_VLAN_ID;
  560. mpass_buf.nbuf = nbuf;
  561. dp_tx_mlo_mcast_multipass_lookup(be_vdev, vdev, &mpass_buf);
  562. if (mpass_buf.vlan_id == INVALID_VLAN_ID) {
  563. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  564. dp_tx_mlo_mcast_multipass_lookup,
  565. &mpass_buf, DP_MOD_ID_TX);
  566. /*
  567. * Do not drop the frame when vlan_id doesn't match.
  568. * Send the frame as it is.
  569. */
  570. if (mpass_buf.vlan_id == INVALID_VLAN_ID)
  571. return false;
  572. }
  573. /* AP can have classic clients, special clients &
  574. * classic repeaters.
  575. * 1. Classic clients & special client:
  576. * Remove vlan header, find corresponding group key
  577. * index, fill in metaheader and enqueue multicast
  578. * frame to TCL.
  579. * 2. Classic repeater:
  580. * Pass through to classic repeater with vlan tag
  581. * intact without any group key index. Hardware
  582. * will know which key to use to send frame to
  583. * repeater.
  584. */
  585. nbuf_copy = qdf_nbuf_copy(nbuf);
  586. /*
  587. * Send multicast frame to special peers even
  588. * if pass through to classic repeater fails.
  589. */
  590. if (nbuf_copy) {
  591. struct dp_mlo_mpass_buf mpass_buf_copy = {0};
  592. mpass_buf_copy.vlan_id = MULTIPASS_WITH_VLAN_ID;
  593. mpass_buf_copy.nbuf = nbuf_copy;
  594. /* send frame on partner vdevs */
  595. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  596. dp_tx_mlo_mcast_multipass_send,
  597. &mpass_buf_copy, DP_MOD_ID_TX);
  598. /* send frame on mcast primary vdev */
  599. dp_tx_mlo_mcast_multipass_send(be_vdev, vdev, &mpass_buf_copy);
  600. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  601. be_vdev->seq_num = 0;
  602. else
  603. be_vdev->seq_num++;
  604. }
  605. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  606. dp_tx_mlo_mcast_multipass_send,
  607. &mpass_buf, DP_MOD_ID_TX);
  608. dp_tx_mlo_mcast_multipass_send(be_vdev, vdev, &mpass_buf);
  609. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  610. be_vdev->seq_num = 0;
  611. else
  612. be_vdev->seq_num++;
  613. return true;
  614. }
  615. #else
  616. static bool
  617. dp_tx_mlo_mcast_multipass_handler(struct dp_soc *soc, struct dp_vdev *vdev,
  618. qdf_nbuf_t nbuf)
  619. {
  620. return false;
  621. }
  622. #endif
  623. void
  624. dp_tx_mlo_mcast_pkt_send(struct dp_vdev_be *be_vdev,
  625. struct dp_vdev *ptnr_vdev,
  626. void *arg)
  627. {
  628. qdf_nbuf_t nbuf = (qdf_nbuf_t)arg;
  629. qdf_nbuf_t nbuf_clone;
  630. struct dp_vdev_be *be_ptnr_vdev = NULL;
  631. struct dp_tx_msdu_info_s msdu_info;
  632. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  633. if (be_vdev != be_ptnr_vdev) {
  634. nbuf_clone = qdf_nbuf_clone(nbuf);
  635. if (qdf_unlikely(!nbuf_clone)) {
  636. dp_tx_debug("nbuf clone failed");
  637. return;
  638. }
  639. } else {
  640. nbuf_clone = nbuf;
  641. }
  642. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  643. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  644. msdu_info.gsn = be_vdev->seq_num;
  645. be_ptnr_vdev->seq_num = be_vdev->seq_num;
  646. nbuf_clone = dp_tx_send_msdu_single(
  647. ptnr_vdev,
  648. nbuf_clone,
  649. &msdu_info,
  650. DP_MLO_MCAST_REINJECT_PEER_ID,
  651. NULL);
  652. if (qdf_unlikely(nbuf_clone)) {
  653. dp_info("pkt send failed");
  654. qdf_nbuf_free(nbuf_clone);
  655. return;
  656. }
  657. }
  658. static inline void
  659. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  660. struct dp_vdev *vdev,
  661. struct dp_tx_msdu_info_s *msdu_info)
  662. {
  663. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, msdu_info->vdev_id);
  664. }
  665. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  666. struct dp_vdev *vdev,
  667. qdf_nbuf_t nbuf)
  668. {
  669. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  670. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  671. if (qdf_unlikely(vdev->multipass_en) &&
  672. dp_tx_mlo_mcast_multipass_handler(soc, vdev, nbuf))
  673. return;
  674. /* send frame on partner vdevs */
  675. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  676. dp_tx_mlo_mcast_pkt_send,
  677. nbuf, DP_MOD_ID_REINJECT);
  678. /* send frame on mcast primary vdev */
  679. dp_tx_mlo_mcast_pkt_send(be_vdev, vdev, nbuf);
  680. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  681. be_vdev->seq_num = 0;
  682. else
  683. be_vdev->seq_num++;
  684. }
  685. bool dp_tx_mlo_is_mcast_primary_be(struct dp_soc *soc,
  686. struct dp_vdev *vdev)
  687. {
  688. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  689. if (be_vdev->mcast_primary)
  690. return true;
  691. return false;
  692. }
  693. #else
  694. static inline void
  695. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  696. struct dp_vdev *vdev,
  697. struct dp_tx_msdu_info_s *msdu_info)
  698. {
  699. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, vdev->vdev_id);
  700. }
  701. #endif
  702. #if defined(WLAN_FEATURE_11BE_MLO) && !defined(WLAN_MLO_MULTI_CHIP) && \
  703. !defined(WLAN_MCAST_MLO)
  704. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  705. struct dp_vdev *vdev,
  706. qdf_nbuf_t nbuf)
  707. {
  708. }
  709. bool dp_tx_mlo_is_mcast_primary_be(struct dp_soc *soc,
  710. struct dp_vdev *vdev)
  711. {
  712. return false;
  713. }
  714. #endif
  715. #ifdef CONFIG_SAWF
  716. void dp_sawf_config_be(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  717. uint16_t *fw_metadata, qdf_nbuf_t nbuf)
  718. {
  719. uint8_t q_id = 0;
  720. if (!wlan_cfg_get_sawf_config(soc->wlan_cfg_ctx))
  721. return;
  722. dp_sawf_tcl_cmd(fw_metadata, nbuf);
  723. q_id = dp_sawf_queue_id_get(nbuf);
  724. if (q_id == DP_SAWF_DEFAULT_Q_INVALID)
  725. return;
  726. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached,
  727. (q_id & (CDP_DATA_TID_MAX - 1)));
  728. hal_tx_desc_set_flow_override_enable(hal_tx_desc_cached,
  729. DP_TX_FLOW_OVERRIDE_ENABLE);
  730. hal_tx_desc_set_flow_override(hal_tx_desc_cached,
  731. DP_TX_FLOW_OVERRIDE_GET(q_id));
  732. hal_tx_desc_set_who_classify_info_sel(hal_tx_desc_cached,
  733. DP_TX_WHO_CLFY_INF_SEL_GET(q_id));
  734. }
  735. #else
  736. static inline
  737. void dp_sawf_config_be(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  738. uint16_t *fw_metadata, qdf_nbuf_t nbuf)
  739. {
  740. }
  741. static inline
  742. QDF_STATUS dp_sawf_tx_enqueue_peer_stats(struct dp_soc *soc,
  743. struct dp_tx_desc_s *tx_desc)
  744. {
  745. return QDF_STATUS_SUCCESS;
  746. }
  747. static inline
  748. QDF_STATUS dp_sawf_tx_enqueue_fail_peer_stats(struct dp_soc *soc,
  749. struct dp_tx_desc_s *tx_desc)
  750. {
  751. return QDF_STATUS_SUCCESS;
  752. }
  753. #endif
  754. #ifdef WLAN_SUPPORT_PPEDS
  755. /**
  756. * dp_ppeds_tx_comp_handler()- Handle tx completions for ppe2tcl ring
  757. * @soc: Handle to DP Soc structure
  758. * @quota: Max number of tx completions to process
  759. *
  760. * Return: Number of tx completions processed
  761. */
  762. int dp_ppeds_tx_comp_handler(struct dp_soc_be *be_soc, uint32_t quota)
  763. {
  764. uint32_t num_avail_for_reap = 0;
  765. void *tx_comp_hal_desc;
  766. uint8_t buf_src;
  767. uint32_t count = 0;
  768. struct dp_tx_desc_s *tx_desc = NULL;
  769. struct dp_tx_desc_s *head_desc = NULL;
  770. struct dp_tx_desc_s *tail_desc = NULL;
  771. struct dp_soc *soc = &be_soc->soc;
  772. void *last_prefetch_hw_desc = NULL;
  773. struct dp_tx_desc_s *last_prefetch_sw_desc = NULL;
  774. hal_soc_handle_t hal_soc = soc->hal_soc;
  775. hal_ring_handle_t hal_ring_hdl =
  776. be_soc->ppeds_wbm_release_ring.hal_srng;
  777. if (qdf_unlikely(dp_srng_access_start(NULL, soc, hal_ring_hdl))) {
  778. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  779. return 0;
  780. }
  781. num_avail_for_reap = hal_srng_dst_num_valid(hal_soc, hal_ring_hdl, 0);
  782. if (num_avail_for_reap >= quota)
  783. num_avail_for_reap = quota;
  784. dp_srng_dst_inv_cached_descs(soc, hal_ring_hdl, num_avail_for_reap);
  785. last_prefetch_hw_desc = dp_srng_dst_prefetch(hal_soc, hal_ring_hdl,
  786. num_avail_for_reap);
  787. while (qdf_likely(num_avail_for_reap--)) {
  788. tx_comp_hal_desc = dp_srng_dst_get_next(soc, hal_ring_hdl);
  789. if (qdf_unlikely(!tx_comp_hal_desc))
  790. break;
  791. buf_src = hal_tx_comp_get_buffer_source(hal_soc,
  792. tx_comp_hal_desc);
  793. if (qdf_unlikely(buf_src != HAL_TX_COMP_RELEASE_SOURCE_TQM &&
  794. buf_src != HAL_TX_COMP_RELEASE_SOURCE_FW)) {
  795. dp_err("Tx comp release_src != TQM | FW but from %d",
  796. buf_src);
  797. qdf_assert_always(0);
  798. }
  799. dp_tx_comp_get_params_from_hal_desc_be(soc, tx_comp_hal_desc,
  800. &tx_desc);
  801. if (!tx_desc) {
  802. dp_err("unable to retrieve tx_desc!");
  803. qdf_assert_always(0);
  804. continue;
  805. }
  806. if (qdf_unlikely(!(tx_desc->flags &
  807. DP_TX_DESC_FLAG_ALLOCATED) ||
  808. !(tx_desc->flags & DP_TX_DESC_FLAG_PPEDS))) {
  809. qdf_assert_always(0);
  810. continue;
  811. }
  812. tx_desc->buffer_src = buf_src;
  813. if (qdf_unlikely(buf_src == HAL_TX_COMP_RELEASE_SOURCE_FW)) {
  814. qdf_nbuf_free(tx_desc->nbuf);
  815. dp_ppeds_tx_desc_free(soc, tx_desc);
  816. } else {
  817. tx_desc->tx_status =
  818. hal_tx_comp_get_tx_status(tx_comp_hal_desc);
  819. if (!head_desc) {
  820. head_desc = tx_desc;
  821. tail_desc = tx_desc;
  822. }
  823. tail_desc->next = tx_desc;
  824. tx_desc->next = NULL;
  825. tail_desc = tx_desc;
  826. count++;
  827. dp_tx_prefetch_hw_sw_nbuf_desc(soc, hal_soc,
  828. num_avail_for_reap,
  829. hal_ring_hdl,
  830. &last_prefetch_hw_desc,
  831. &last_prefetch_sw_desc);
  832. }
  833. }
  834. dp_srng_access_end(NULL, soc, hal_ring_hdl);
  835. if (head_desc)
  836. dp_tx_comp_process_desc_list(soc, head_desc,
  837. CDP_MAX_TX_COMP_PPE_RING);
  838. return count;
  839. }
  840. #endif
  841. #if defined(QCA_SUPPORT_WDS_EXTENDED)
  842. static inline void
  843. dp_get_peer_from_tx_exc_meta(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  844. struct cdp_tx_exception_metadata *tx_exc_metadata,
  845. uint16_t *ast_idx, uint16_t *ast_hash)
  846. {
  847. struct dp_peer *peer = NULL;
  848. if (tx_exc_metadata->is_wds_extended) {
  849. peer = dp_peer_get_ref_by_id(soc, tx_exc_metadata->peer_id,
  850. DP_MOD_ID_TX);
  851. if (peer) {
  852. *ast_idx = peer->ast_idx;
  853. *ast_hash = peer->ast_hash;
  854. hal_tx_desc_set_index_lookup_override
  855. (soc->hal_soc,
  856. hal_tx_desc_cached,
  857. 0x1);
  858. dp_peer_unref_delete(peer, DP_MOD_ID_TX);
  859. }
  860. } else {
  861. return;
  862. }
  863. }
  864. #else
  865. static inline void
  866. dp_get_peer_from_tx_exc_meta(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  867. struct cdp_tx_exception_metadata *tx_exc_metadata,
  868. uint16_t *ast_idx, uint16_t *ast_hash)
  869. {
  870. }
  871. #endif
  872. QDF_STATUS
  873. dp_tx_hw_enqueue_be(struct dp_soc *soc, struct dp_vdev *vdev,
  874. struct dp_tx_desc_s *tx_desc, uint16_t fw_metadata,
  875. struct cdp_tx_exception_metadata *tx_exc_metadata,
  876. struct dp_tx_msdu_info_s *msdu_info)
  877. {
  878. void *hal_tx_desc;
  879. uint32_t *hal_tx_desc_cached;
  880. int coalesce = 0;
  881. struct dp_tx_queue *tx_q = &msdu_info->tx_queue;
  882. uint8_t ring_id = tx_q->ring_id;
  883. uint8_t tid = msdu_info->tid;
  884. struct dp_vdev_be *be_vdev;
  885. uint8_t cached_desc[HAL_TX_DESC_LEN_BYTES] = { 0 };
  886. uint8_t bm_id = dp_tx_get_rbm_id_be(soc, ring_id);
  887. hal_ring_handle_t hal_ring_hdl = NULL;
  888. QDF_STATUS status = QDF_STATUS_E_RESOURCES;
  889. uint8_t num_desc_bytes = HAL_TX_DESC_LEN_BYTES;
  890. uint16_t ast_idx = vdev->bss_ast_idx;
  891. uint16_t ast_hash = vdev->bss_ast_hash;
  892. be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  893. if (!dp_tx_is_desc_id_valid(soc, tx_desc->id)) {
  894. dp_err_rl("Invalid tx desc id:%d", tx_desc->id);
  895. return QDF_STATUS_E_RESOURCES;
  896. }
  897. if (qdf_unlikely(tx_exc_metadata)) {
  898. qdf_assert_always((tx_exc_metadata->tx_encap_type ==
  899. CDP_INVALID_TX_ENCAP_TYPE) ||
  900. (tx_exc_metadata->tx_encap_type ==
  901. vdev->tx_encap_type));
  902. if (tx_exc_metadata->tx_encap_type == htt_cmn_pkt_type_raw)
  903. qdf_assert_always((tx_exc_metadata->sec_type ==
  904. CDP_INVALID_SEC_TYPE) ||
  905. tx_exc_metadata->sec_type ==
  906. vdev->sec_type);
  907. dp_get_peer_from_tx_exc_meta(soc, (void *)cached_desc,
  908. tx_exc_metadata,
  909. &ast_idx, &ast_hash);
  910. }
  911. hal_tx_desc_cached = (void *)cached_desc;
  912. if (dp_sawf_tag_valid_get(tx_desc->nbuf)) {
  913. dp_sawf_config_be(soc, hal_tx_desc_cached,
  914. &fw_metadata, tx_desc->nbuf);
  915. dp_sawf_tx_enqueue_peer_stats(soc, tx_desc);
  916. }
  917. hal_tx_desc_set_buf_addr_be(soc->hal_soc, hal_tx_desc_cached,
  918. tx_desc->dma_addr, bm_id, tx_desc->id,
  919. (tx_desc->flags & DP_TX_DESC_FLAG_FRAG));
  920. hal_tx_desc_set_lmac_id_be(soc->hal_soc, hal_tx_desc_cached,
  921. vdev->lmac_id);
  922. hal_tx_desc_set_search_index_be(soc->hal_soc, hal_tx_desc_cached,
  923. ast_idx);
  924. /*
  925. * Bank_ID is used as DSCP_TABLE number in beryllium
  926. * So there is no explicit field used for DSCP_TID_TABLE_NUM.
  927. */
  928. hal_tx_desc_set_cache_set_num(soc->hal_soc, hal_tx_desc_cached,
  929. (ast_hash & 0xF));
  930. hal_tx_desc_set_fw_metadata(hal_tx_desc_cached, fw_metadata);
  931. hal_tx_desc_set_buf_length(hal_tx_desc_cached, tx_desc->length);
  932. hal_tx_desc_set_buf_offset(hal_tx_desc_cached, tx_desc->pkt_offset);
  933. if (tx_desc->flags & DP_TX_DESC_FLAG_TO_FW)
  934. hal_tx_desc_set_to_fw(hal_tx_desc_cached, 1);
  935. /* verify checksum offload configuration*/
  936. if ((qdf_nbuf_get_tx_cksum(tx_desc->nbuf) ==
  937. QDF_NBUF_TX_CKSUM_TCP_UDP) ||
  938. qdf_nbuf_is_tso(tx_desc->nbuf)) {
  939. hal_tx_desc_set_l3_checksum_en(hal_tx_desc_cached, 1);
  940. hal_tx_desc_set_l4_checksum_en(hal_tx_desc_cached, 1);
  941. }
  942. hal_tx_desc_set_bank_id(hal_tx_desc_cached, vdev->bank_id);
  943. dp_tx_vdev_id_set_hal_tx_desc(hal_tx_desc_cached, vdev, msdu_info);
  944. if (tid != HTT_TX_EXT_TID_INVALID)
  945. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached, tid);
  946. dp_tx_set_min_rates_for_critical_frames(soc, hal_tx_desc_cached,
  947. tx_desc->nbuf);
  948. dp_tx_desc_set_ktimestamp(vdev, tx_desc);
  949. hal_ring_hdl = dp_tx_get_hal_ring_hdl(soc, ring_id);
  950. if (qdf_unlikely(dp_tx_hal_ring_access_start(soc, hal_ring_hdl))) {
  951. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  952. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  953. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  954. dp_sawf_tx_enqueue_fail_peer_stats(soc, tx_desc);
  955. return status;
  956. }
  957. hal_tx_desc = hal_srng_src_get_next(soc->hal_soc, hal_ring_hdl);
  958. if (qdf_unlikely(!hal_tx_desc)) {
  959. dp_verbose_debug("TCL ring full ring_id:%d", ring_id);
  960. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  961. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  962. dp_sawf_tx_enqueue_fail_peer_stats(soc, tx_desc);
  963. goto ring_access_fail;
  964. }
  965. tx_desc->flags |= DP_TX_DESC_FLAG_QUEUED_TX;
  966. dp_vdev_peer_stats_update_protocol_cnt_tx(vdev, tx_desc->nbuf);
  967. /* Sync cached descriptor with HW */
  968. hal_tx_desc_sync(hal_tx_desc_cached, hal_tx_desc, num_desc_bytes);
  969. coalesce = dp_tx_attempt_coalescing(soc, vdev, tx_desc, tid,
  970. msdu_info, ring_id);
  971. DP_STATS_INC_PKT(vdev, tx_i.processed, 1, dp_tx_get_pkt_len(tx_desc));
  972. DP_STATS_INC(soc, tx.tcl_enq[ring_id], 1);
  973. dp_tx_update_stats(soc, tx_desc, ring_id);
  974. status = QDF_STATUS_SUCCESS;
  975. dp_tx_hw_desc_update_evt((uint8_t *)hal_tx_desc_cached,
  976. hal_ring_hdl, soc, ring_id);
  977. ring_access_fail:
  978. dp_tx_ring_access_end_wrapper(soc, hal_ring_hdl, coalesce);
  979. dp_pkt_add_timestamp(vdev, QDF_PKT_TX_DRIVER_EXIT,
  980. qdf_get_log_timestamp(), tx_desc->nbuf);
  981. return status;
  982. }
  983. #ifdef IPA_OFFLOAD
  984. static void
  985. dp_tx_get_ipa_bank_config(struct dp_soc_be *be_soc,
  986. union hal_tx_bank_config *bank_config)
  987. {
  988. bank_config->epd = 0;
  989. bank_config->encap_type = wlan_cfg_pkt_type(be_soc->soc.wlan_cfg_ctx);
  990. bank_config->encrypt_type = 0;
  991. bank_config->src_buffer_swap = 0;
  992. bank_config->link_meta_swap = 0;
  993. bank_config->index_lookup_enable = 0;
  994. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_FW_EXCEPTION;
  995. bank_config->addrx_en = 1;
  996. bank_config->addry_en = 1;
  997. bank_config->mesh_enable = 0;
  998. bank_config->dscp_tid_map_id = 0;
  999. bank_config->vdev_id_check_en = 0;
  1000. bank_config->pmac_id = 0;
  1001. }
  1002. static void dp_tx_init_ipa_bank_profile(struct dp_soc_be *be_soc)
  1003. {
  1004. union hal_tx_bank_config ipa_config = {0};
  1005. int bid;
  1006. if (!wlan_cfg_is_ipa_enabled(be_soc->soc.wlan_cfg_ctx)) {
  1007. be_soc->ipa_bank_id = DP_BE_INVALID_BANK_ID;
  1008. return;
  1009. }
  1010. dp_tx_get_ipa_bank_config(be_soc, &ipa_config);
  1011. /* Let IPA use last HOST owned bank */
  1012. bid = be_soc->num_bank_profiles - 1;
  1013. be_soc->bank_profiles[bid].is_configured = true;
  1014. be_soc->bank_profiles[bid].bank_config.val = ipa_config.val;
  1015. hal_tx_populate_bank_register(be_soc->soc.hal_soc,
  1016. &be_soc->bank_profiles[bid].bank_config,
  1017. bid);
  1018. qdf_atomic_inc(&be_soc->bank_profiles[bid].ref_count);
  1019. dp_info("IPA bank at slot %d config:0x%x", bid,
  1020. be_soc->bank_profiles[bid].bank_config.val);
  1021. be_soc->ipa_bank_id = bid;
  1022. }
  1023. #else /* !IPA_OFFLOAD */
  1024. static inline void dp_tx_init_ipa_bank_profile(struct dp_soc_be *be_soc)
  1025. {
  1026. }
  1027. #endif /* IPA_OFFLOAD */
  1028. QDF_STATUS dp_tx_init_bank_profiles(struct dp_soc_be *be_soc)
  1029. {
  1030. int i, num_tcl_banks;
  1031. num_tcl_banks = hal_tx_get_num_tcl_banks(be_soc->soc.hal_soc);
  1032. qdf_assert_always(num_tcl_banks);
  1033. be_soc->num_bank_profiles = num_tcl_banks;
  1034. be_soc->bank_profiles = qdf_mem_malloc(num_tcl_banks *
  1035. sizeof(*be_soc->bank_profiles));
  1036. if (!be_soc->bank_profiles) {
  1037. dp_err("unable to allocate memory for DP TX Profiles!");
  1038. return QDF_STATUS_E_NOMEM;
  1039. }
  1040. DP_TX_BANK_LOCK_CREATE(&be_soc->tx_bank_lock);
  1041. for (i = 0; i < num_tcl_banks; i++) {
  1042. be_soc->bank_profiles[i].is_configured = false;
  1043. qdf_atomic_init(&be_soc->bank_profiles[i].ref_count);
  1044. }
  1045. dp_info("initialized %u bank profiles", be_soc->num_bank_profiles);
  1046. dp_tx_init_ipa_bank_profile(be_soc);
  1047. return QDF_STATUS_SUCCESS;
  1048. }
  1049. void dp_tx_deinit_bank_profiles(struct dp_soc_be *be_soc)
  1050. {
  1051. qdf_mem_free(be_soc->bank_profiles);
  1052. DP_TX_BANK_LOCK_DESTROY(&be_soc->tx_bank_lock);
  1053. }
  1054. static
  1055. void dp_tx_get_vdev_bank_config(struct dp_vdev_be *be_vdev,
  1056. union hal_tx_bank_config *bank_config)
  1057. {
  1058. struct dp_vdev *vdev = &be_vdev->vdev;
  1059. bank_config->epd = 0;
  1060. bank_config->encap_type = vdev->tx_encap_type;
  1061. /* Only valid for raw frames. Needs work for RAW mode */
  1062. if (vdev->tx_encap_type == htt_cmn_pkt_type_raw) {
  1063. bank_config->encrypt_type = sec_type_map[vdev->sec_type];
  1064. } else {
  1065. bank_config->encrypt_type = 0;
  1066. }
  1067. bank_config->src_buffer_swap = 0;
  1068. bank_config->link_meta_swap = 0;
  1069. if ((vdev->search_type == HAL_TX_ADDR_INDEX_SEARCH) &&
  1070. vdev->opmode == wlan_op_mode_sta) {
  1071. bank_config->index_lookup_enable = 1;
  1072. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_MEC_NOTIFY;
  1073. bank_config->addrx_en = 0;
  1074. bank_config->addry_en = 0;
  1075. } else {
  1076. bank_config->index_lookup_enable = 0;
  1077. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_FW_EXCEPTION;
  1078. bank_config->addrx_en =
  1079. (vdev->hal_desc_addr_search_flags &
  1080. HAL_TX_DESC_ADDRX_EN) ? 1 : 0;
  1081. bank_config->addry_en =
  1082. (vdev->hal_desc_addr_search_flags &
  1083. HAL_TX_DESC_ADDRY_EN) ? 1 : 0;
  1084. }
  1085. bank_config->mesh_enable = vdev->mesh_vdev ? 1 : 0;
  1086. bank_config->dscp_tid_map_id = vdev->dscp_tid_map_id;
  1087. /* Disabling vdev id check for now. Needs revist. */
  1088. bank_config->vdev_id_check_en = be_vdev->vdev_id_check_en;
  1089. bank_config->pmac_id = vdev->lmac_id;
  1090. }
  1091. int dp_tx_get_bank_profile(struct dp_soc_be *be_soc,
  1092. struct dp_vdev_be *be_vdev)
  1093. {
  1094. char *temp_str = "";
  1095. bool found_match = false;
  1096. int bank_id = DP_BE_INVALID_BANK_ID;
  1097. int i;
  1098. int unconfigured_slot = DP_BE_INVALID_BANK_ID;
  1099. int zero_ref_count_slot = DP_BE_INVALID_BANK_ID;
  1100. union hal_tx_bank_config vdev_config = {0};
  1101. /* convert vdev params into hal_tx_bank_config */
  1102. dp_tx_get_vdev_bank_config(be_vdev, &vdev_config);
  1103. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  1104. /* go over all banks and find a matching/unconfigured/unused bank */
  1105. for (i = 0; i < be_soc->num_bank_profiles; i++) {
  1106. if (be_soc->bank_profiles[i].is_configured &&
  1107. (be_soc->bank_profiles[i].bank_config.val ^
  1108. vdev_config.val) == 0) {
  1109. found_match = true;
  1110. break;
  1111. }
  1112. if (unconfigured_slot == DP_BE_INVALID_BANK_ID &&
  1113. !be_soc->bank_profiles[i].is_configured)
  1114. unconfigured_slot = i;
  1115. else if (zero_ref_count_slot == DP_BE_INVALID_BANK_ID &&
  1116. !qdf_atomic_read(&be_soc->bank_profiles[i].ref_count))
  1117. zero_ref_count_slot = i;
  1118. }
  1119. if (found_match) {
  1120. temp_str = "matching";
  1121. bank_id = i;
  1122. goto inc_ref_and_return;
  1123. }
  1124. if (unconfigured_slot != DP_BE_INVALID_BANK_ID) {
  1125. temp_str = "unconfigured";
  1126. bank_id = unconfigured_slot;
  1127. goto configure_and_return;
  1128. }
  1129. if (zero_ref_count_slot != DP_BE_INVALID_BANK_ID) {
  1130. temp_str = "zero_ref_count";
  1131. bank_id = zero_ref_count_slot;
  1132. }
  1133. if (bank_id == DP_BE_INVALID_BANK_ID) {
  1134. dp_alert("unable to find TX bank!");
  1135. QDF_BUG(0);
  1136. return bank_id;
  1137. }
  1138. configure_and_return:
  1139. be_soc->bank_profiles[bank_id].is_configured = true;
  1140. be_soc->bank_profiles[bank_id].bank_config.val = vdev_config.val;
  1141. hal_tx_populate_bank_register(be_soc->soc.hal_soc,
  1142. &be_soc->bank_profiles[bank_id].bank_config,
  1143. bank_id);
  1144. inc_ref_and_return:
  1145. qdf_atomic_inc(&be_soc->bank_profiles[bank_id].ref_count);
  1146. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  1147. dp_info("found %s slot at index %d, input:0x%x match:0x%x ref_count %u",
  1148. temp_str, bank_id, vdev_config.val,
  1149. be_soc->bank_profiles[bank_id].bank_config.val,
  1150. qdf_atomic_read(&be_soc->bank_profiles[bank_id].ref_count));
  1151. 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",
  1152. be_soc->bank_profiles[bank_id].bank_config.epd,
  1153. be_soc->bank_profiles[bank_id].bank_config.encap_type,
  1154. be_soc->bank_profiles[bank_id].bank_config.encrypt_type,
  1155. be_soc->bank_profiles[bank_id].bank_config.src_buffer_swap,
  1156. be_soc->bank_profiles[bank_id].bank_config.link_meta_swap,
  1157. be_soc->bank_profiles[bank_id].bank_config.addrx_en,
  1158. be_soc->bank_profiles[bank_id].bank_config.addry_en,
  1159. be_soc->bank_profiles[bank_id].bank_config.mesh_enable,
  1160. be_soc->bank_profiles[bank_id].bank_config.vdev_id_check_en,
  1161. be_soc->bank_profiles[bank_id].bank_config.pmac_id,
  1162. be_soc->bank_profiles[bank_id].bank_config.mcast_pkt_ctrl);
  1163. return bank_id;
  1164. }
  1165. void dp_tx_put_bank_profile(struct dp_soc_be *be_soc,
  1166. struct dp_vdev_be *be_vdev)
  1167. {
  1168. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  1169. qdf_atomic_dec(&be_soc->bank_profiles[be_vdev->bank_id].ref_count);
  1170. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  1171. }
  1172. void dp_tx_update_bank_profile(struct dp_soc_be *be_soc,
  1173. struct dp_vdev_be *be_vdev)
  1174. {
  1175. dp_tx_put_bank_profile(be_soc, be_vdev);
  1176. be_vdev->bank_id = dp_tx_get_bank_profile(be_soc, be_vdev);
  1177. be_vdev->vdev.bank_id = be_vdev->bank_id;
  1178. }
  1179. QDF_STATUS dp_tx_desc_pool_init_be(struct dp_soc *soc,
  1180. uint32_t num_elem,
  1181. uint8_t pool_id)
  1182. {
  1183. struct dp_tx_desc_pool_s *tx_desc_pool;
  1184. struct dp_hw_cookie_conversion_t *cc_ctx;
  1185. struct dp_soc_be *be_soc;
  1186. struct dp_spt_page_desc *page_desc;
  1187. struct dp_tx_desc_s *tx_desc;
  1188. uint32_t ppt_idx = 0;
  1189. uint32_t avail_entry_index = 0;
  1190. if (!num_elem) {
  1191. dp_err("desc_num 0 !!");
  1192. return QDF_STATUS_E_FAILURE;
  1193. }
  1194. be_soc = dp_get_be_soc_from_dp_soc(soc);
  1195. tx_desc_pool = &soc->tx_desc[pool_id];
  1196. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  1197. tx_desc = tx_desc_pool->freelist;
  1198. page_desc = &cc_ctx->page_desc_base[0];
  1199. while (tx_desc) {
  1200. if (avail_entry_index == 0) {
  1201. if (ppt_idx >= cc_ctx->total_page_num) {
  1202. dp_alert("insufficient secondary page tables");
  1203. qdf_assert_always(0);
  1204. }
  1205. page_desc = &cc_ctx->page_desc_base[ppt_idx++];
  1206. }
  1207. /* put each TX Desc VA to SPT pages and
  1208. * get corresponding ID
  1209. */
  1210. DP_CC_SPT_PAGE_UPDATE_VA(page_desc->page_v_addr,
  1211. avail_entry_index,
  1212. tx_desc);
  1213. tx_desc->id =
  1214. dp_cc_desc_id_generate(page_desc->ppt_index,
  1215. avail_entry_index);
  1216. tx_desc->pool_id = pool_id;
  1217. dp_tx_desc_set_magic(tx_desc, DP_TX_MAGIC_PATTERN_FREE);
  1218. tx_desc = tx_desc->next;
  1219. avail_entry_index = (avail_entry_index + 1) &
  1220. DP_CC_SPT_PAGE_MAX_ENTRIES_MASK;
  1221. }
  1222. return QDF_STATUS_SUCCESS;
  1223. }
  1224. void dp_tx_desc_pool_deinit_be(struct dp_soc *soc,
  1225. struct dp_tx_desc_pool_s *tx_desc_pool,
  1226. uint8_t pool_id)
  1227. {
  1228. struct dp_spt_page_desc *page_desc;
  1229. struct dp_soc_be *be_soc;
  1230. int i = 0;
  1231. struct dp_hw_cookie_conversion_t *cc_ctx;
  1232. be_soc = dp_get_be_soc_from_dp_soc(soc);
  1233. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  1234. for (i = 0; i < cc_ctx->total_page_num; i++) {
  1235. page_desc = &cc_ctx->page_desc_base[i];
  1236. qdf_mem_zero(page_desc->page_v_addr, qdf_page_size);
  1237. }
  1238. }
  1239. #ifdef WLAN_FEATURE_NEAR_FULL_IRQ
  1240. uint32_t dp_tx_comp_nf_handler(struct dp_intr *int_ctx, struct dp_soc *soc,
  1241. hal_ring_handle_t hal_ring_hdl, uint8_t ring_id,
  1242. uint32_t quota)
  1243. {
  1244. struct dp_srng *tx_comp_ring = &soc->tx_comp_ring[ring_id];
  1245. uint32_t work_done = 0;
  1246. if (dp_srng_get_near_full_level(soc, tx_comp_ring) <
  1247. DP_SRNG_THRESH_NEAR_FULL)
  1248. return 0;
  1249. qdf_atomic_set(&tx_comp_ring->near_full, 1);
  1250. work_done++;
  1251. return work_done;
  1252. }
  1253. #endif
  1254. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  1255. defined(WLAN_CONFIG_TX_DELAY)
  1256. #define PPDUID_GET_HW_LINK_ID(PPDU_ID, LINK_ID_OFFSET, LINK_ID_BITS) \
  1257. (((PPDU_ID) >> (LINK_ID_OFFSET)) & ((1 << (LINK_ID_BITS)) - 1))
  1258. #define HW_TX_DELAY_MAX 0x1000000
  1259. #define TX_COMPL_SHIFT_BUFFER_TIMESTAMP_US 10
  1260. #define HW_TX_DELAY_MASK 0x1FFFFFFF
  1261. #define TX_COMPL_BUFFER_TSTAMP_US(TSTAMP) \
  1262. (((TSTAMP) << TX_COMPL_SHIFT_BUFFER_TIMESTAMP_US) & \
  1263. HW_TX_DELAY_MASK)
  1264. static inline
  1265. QDF_STATUS dp_mlo_compute_hw_delay_us(struct dp_soc *soc,
  1266. struct dp_vdev *vdev,
  1267. struct hal_tx_completion_status *ts,
  1268. uint32_t *delay_us)
  1269. {
  1270. uint32_t ppdu_id;
  1271. uint8_t link_id_offset, link_id_bits;
  1272. uint8_t hw_link_id;
  1273. uint32_t msdu_tqm_enqueue_tstamp_us, final_msdu_tqm_enqueue_tstamp_us;
  1274. uint32_t msdu_compl_tsf_tstamp_us, final_msdu_compl_tsf_tstamp_us;
  1275. uint32_t delay;
  1276. int32_t delta_tsf2, delta_tqm;
  1277. if (!ts->valid)
  1278. return QDF_STATUS_E_INVAL;
  1279. link_id_offset = soc->link_id_offset;
  1280. link_id_bits = soc->link_id_bits;
  1281. ppdu_id = ts->ppdu_id;
  1282. hw_link_id = PPDUID_GET_HW_LINK_ID(ppdu_id, link_id_offset,
  1283. link_id_bits);
  1284. msdu_tqm_enqueue_tstamp_us =
  1285. TX_COMPL_BUFFER_TSTAMP_US(ts->buffer_timestamp);
  1286. msdu_compl_tsf_tstamp_us = ts->tsf;
  1287. delta_tsf2 = dp_mlo_get_delta_tsf2_wrt_mlo_offset(soc, hw_link_id);
  1288. delta_tqm = dp_mlo_get_delta_tqm_wrt_mlo_offset(soc);
  1289. final_msdu_tqm_enqueue_tstamp_us = (msdu_tqm_enqueue_tstamp_us +
  1290. delta_tqm) & HW_TX_DELAY_MASK;
  1291. final_msdu_compl_tsf_tstamp_us = (msdu_compl_tsf_tstamp_us +
  1292. delta_tsf2) & HW_TX_DELAY_MASK;
  1293. delay = (final_msdu_compl_tsf_tstamp_us -
  1294. final_msdu_tqm_enqueue_tstamp_us) & HW_TX_DELAY_MASK;
  1295. if (delay > HW_TX_DELAY_MAX)
  1296. return QDF_STATUS_E_FAILURE;
  1297. if (delay_us)
  1298. *delay_us = delay;
  1299. return QDF_STATUS_SUCCESS;
  1300. }
  1301. #else
  1302. static inline
  1303. QDF_STATUS dp_mlo_compute_hw_delay_us(struct dp_soc *soc,
  1304. struct dp_vdev *vdev,
  1305. struct hal_tx_completion_status *ts,
  1306. uint32_t *delay_us)
  1307. {
  1308. return QDF_STATUS_SUCCESS;
  1309. }
  1310. #endif
  1311. QDF_STATUS dp_tx_compute_tx_delay_be(struct dp_soc *soc,
  1312. struct dp_vdev *vdev,
  1313. struct hal_tx_completion_status *ts,
  1314. uint32_t *delay_us)
  1315. {
  1316. return dp_mlo_compute_hw_delay_us(soc, vdev, ts, delay_us);
  1317. }
  1318. static inline
  1319. qdf_dma_addr_t dp_tx_nbuf_map_be(struct dp_vdev *vdev,
  1320. struct dp_tx_desc_s *tx_desc,
  1321. qdf_nbuf_t nbuf)
  1322. {
  1323. qdf_nbuf_dma_clean_range_no_dsb((void *)nbuf->data,
  1324. (void *)(nbuf->data + 256));
  1325. return (qdf_dma_addr_t)qdf_mem_virt_to_phys(nbuf->data);
  1326. }
  1327. static inline
  1328. void dp_tx_nbuf_unmap_be(struct dp_soc *soc,
  1329. struct dp_tx_desc_s *desc)
  1330. {
  1331. }
  1332. /**
  1333. * dp_tx_fast_send_be() - Transmit a frame on a given VAP
  1334. * @soc: DP soc handle
  1335. * @vdev_id: id of DP vdev handle
  1336. * @nbuf: skb
  1337. *
  1338. * Entry point for Core Tx layer (DP_TX) invoked from
  1339. * hard_start_xmit in OSIF/HDD or from dp_rx_process for intravap forwarding
  1340. * cases
  1341. *
  1342. * Return: NULL on success,
  1343. * nbuf when it fails to send
  1344. */
  1345. #ifdef QCA_DP_TX_NBUF_LIST_FREE
  1346. qdf_nbuf_t dp_tx_fast_send_be(struct cdp_soc_t *soc_hdl, uint8_t vdev_id,
  1347. qdf_nbuf_t nbuf)
  1348. {
  1349. struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
  1350. struct dp_vdev *vdev = NULL;
  1351. struct dp_pdev *pdev = NULL;
  1352. struct dp_tx_desc_s *tx_desc;
  1353. uint16_t desc_pool_id;
  1354. uint16_t pkt_len;
  1355. qdf_dma_addr_t paddr;
  1356. QDF_STATUS status = QDF_STATUS_E_RESOURCES;
  1357. uint8_t cached_desc[HAL_TX_DESC_LEN_BYTES] = { 0 };
  1358. hal_ring_handle_t hal_ring_hdl = NULL;
  1359. uint32_t *hal_tx_desc_cached;
  1360. void *hal_tx_desc;
  1361. uint8_t desc_size = DP_TX_FAST_DESC_SIZE;
  1362. if (qdf_unlikely(vdev_id >= MAX_VDEV_CNT))
  1363. return nbuf;
  1364. vdev = soc->vdev_id_map[vdev_id];
  1365. if (qdf_unlikely(!vdev))
  1366. return nbuf;
  1367. desc_pool_id = qdf_nbuf_get_queue_mapping(nbuf) & DP_TX_QUEUE_MASK;
  1368. pkt_len = qdf_nbuf_headlen(nbuf);
  1369. DP_STATS_INC_PKT(vdev, tx_i.rcvd, 1, pkt_len);
  1370. DP_STATS_INC(vdev, tx_i.rcvd_in_fast_xmit_flow, 1);
  1371. DP_STATS_INC(vdev, tx_i.rcvd_per_core[desc_pool_id], 1);
  1372. pdev = vdev->pdev;
  1373. if (dp_tx_limit_check(vdev, nbuf))
  1374. return nbuf;
  1375. tx_desc = dp_tx_desc_alloc(soc, desc_pool_id);
  1376. if (qdf_unlikely(!tx_desc)) {
  1377. DP_STATS_INC(vdev, tx_i.dropped.desc_na.num, 1);
  1378. DP_STATS_INC(vdev, tx_i.dropped.desc_na_exc_alloc_fail.num, 1);
  1379. return nbuf;
  1380. }
  1381. dp_tx_outstanding_inc(pdev);
  1382. /* Initialize the SW tx descriptor */
  1383. tx_desc->nbuf = nbuf;
  1384. tx_desc->shinfo_addr = skb_end_pointer(nbuf);
  1385. tx_desc->frm_type = dp_tx_frm_std;
  1386. tx_desc->tx_encap_type = vdev->tx_encap_type;
  1387. tx_desc->vdev_id = vdev_id;
  1388. tx_desc->pdev = pdev;
  1389. tx_desc->pkt_offset = 0;
  1390. tx_desc->length = pkt_len;
  1391. tx_desc->flags |= DP_TX_DESC_FLAG_SIMPLE;
  1392. tx_desc->nbuf->fast_recycled = 1;
  1393. if (nbuf->is_from_recycler && nbuf->fast_xmit)
  1394. tx_desc->flags |= DP_TX_DESC_FLAG_FAST;
  1395. paddr = dp_tx_nbuf_map_be(vdev, tx_desc, nbuf);
  1396. if (!paddr) {
  1397. /* Handle failure */
  1398. dp_err("qdf_nbuf_map failed");
  1399. DP_STATS_INC(vdev, tx_i.dropped.dma_error, 1);
  1400. goto release_desc;
  1401. }
  1402. tx_desc->dma_addr = paddr;
  1403. hal_tx_desc_cached = (void *)cached_desc;
  1404. hal_tx_desc_cached[0] = (uint32_t)tx_desc->dma_addr;
  1405. hal_tx_desc_cached[1] = tx_desc->id <<
  1406. TCL_DATA_CMD_BUF_ADDR_INFO_SW_BUFFER_COOKIE_LSB;
  1407. /* bank_id */
  1408. hal_tx_desc_cached[2] = vdev->bank_id << TCL_DATA_CMD_BANK_ID_LSB;
  1409. hal_tx_desc_cached[3] = vdev->htt_tcl_metadata <<
  1410. TCL_DATA_CMD_TCL_CMD_NUMBER_LSB;
  1411. hal_tx_desc_cached[4] = tx_desc->length;
  1412. /* l3 and l4 checksum enable */
  1413. hal_tx_desc_cached[4] |= DP_TX_L3_L4_CSUM_ENABLE <<
  1414. TCL_DATA_CMD_IPV4_CHECKSUM_EN_LSB;
  1415. hal_tx_desc_cached[5] = vdev->lmac_id << TCL_DATA_CMD_PMAC_ID_LSB;
  1416. hal_tx_desc_cached[5] |= vdev->vdev_id << TCL_DATA_CMD_VDEV_ID_LSB;
  1417. if (vdev->opmode == wlan_op_mode_sta) {
  1418. hal_tx_desc_cached[6] = vdev->bss_ast_idx |
  1419. ((vdev->bss_ast_hash & 0xF) <<
  1420. TCL_DATA_CMD_CACHE_SET_NUM_LSB);
  1421. desc_size = DP_TX_FAST_DESC_SIZE + 4;
  1422. }
  1423. hal_ring_hdl = dp_tx_get_hal_ring_hdl(soc, desc_pool_id);
  1424. if (qdf_unlikely(dp_tx_hal_ring_access_start(soc, hal_ring_hdl))) {
  1425. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  1426. DP_STATS_INC(soc, tx.tcl_ring_full[desc_pool_id], 1);
  1427. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  1428. goto ring_access_fail2;
  1429. }
  1430. hal_tx_desc = hal_srng_src_get_next(soc->hal_soc, hal_ring_hdl);
  1431. if (qdf_unlikely(!hal_tx_desc)) {
  1432. dp_verbose_debug("TCL ring full ring_id:%d", desc_pool_id);
  1433. DP_STATS_INC(soc, tx.tcl_ring_full[desc_pool_id], 1);
  1434. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  1435. goto ring_access_fail;
  1436. }
  1437. tx_desc->flags |= DP_TX_DESC_FLAG_QUEUED_TX;
  1438. /* Sync cached descriptor with HW */
  1439. qdf_mem_copy(hal_tx_desc, hal_tx_desc_cached, desc_size);
  1440. qdf_dsb();
  1441. DP_STATS_INC_PKT(vdev, tx_i.processed, 1, tx_desc->length);
  1442. DP_STATS_INC(soc, tx.tcl_enq[desc_pool_id], 1);
  1443. status = QDF_STATUS_SUCCESS;
  1444. ring_access_fail:
  1445. dp_tx_ring_access_end_wrapper(soc, hal_ring_hdl, 0);
  1446. ring_access_fail2:
  1447. if (status != QDF_STATUS_SUCCESS) {
  1448. dp_tx_nbuf_unmap_be(soc, tx_desc);
  1449. goto release_desc;
  1450. }
  1451. return NULL;
  1452. release_desc:
  1453. dp_tx_desc_release(tx_desc, desc_pool_id);
  1454. return nbuf;
  1455. }
  1456. #endif