dp_be_tx.c 53 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908
  1. /*
  2. * Copyright (c) 2016-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2023 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_be() - Get the RBM ID for data transmission completion.
  370. * @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. * @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. #ifdef DP_TX_PACKET_INSPECT_FOR_ILP
  442. /**
  443. * dp_tx_set_particular_tx_queue() - set particular TX TQM flow queue 3 for
  444. * TX packets, currently TCP ACK only
  445. * @soc: DP soc structure pointer
  446. * @hal_tx_desc: HAL descriptor where fields are set
  447. * @nbuf: skb to be considered for particular TX queue
  448. *
  449. * Return: None
  450. */
  451. static inline
  452. void dp_tx_set_particular_tx_queue(struct dp_soc *soc,
  453. uint32_t *hal_tx_desc,
  454. qdf_nbuf_t nbuf)
  455. {
  456. if (!soc->wlan_cfg_ctx->tx_pkt_inspect_for_ilp)
  457. return;
  458. if (qdf_unlikely(QDF_NBUF_CB_GET_PACKET_TYPE(nbuf) ==
  459. QDF_NBUF_CB_PACKET_TYPE_TCP_ACK)) {
  460. hal_tx_desc_set_flow_override_enable(hal_tx_desc, 1);
  461. hal_tx_desc_set_flow_override(hal_tx_desc, 1);
  462. hal_tx_desc_set_who_classify_info_sel(hal_tx_desc, 1);
  463. }
  464. }
  465. #else
  466. static inline
  467. void dp_tx_set_particular_tx_queue(struct dp_soc *soc,
  468. uint32_t *hal_tx_desc,
  469. qdf_nbuf_t nbuf)
  470. {
  471. }
  472. #endif
  473. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  474. defined(WLAN_MCAST_MLO)
  475. #ifdef QCA_MULTIPASS_SUPPORT
  476. /**
  477. * dp_tx_mlo_mcast_multipass_lookup() - lookup vlan_id in mpass peer list
  478. * @be_vdev: Handle to DP be_vdev structure
  479. * @ptnr_vdev: DP ptnr_vdev handle
  480. * @arg: pointer to dp_mlo_mpass_ buf
  481. *
  482. * Return: None
  483. */
  484. static void
  485. dp_tx_mlo_mcast_multipass_lookup(struct dp_vdev_be *be_vdev,
  486. struct dp_vdev *ptnr_vdev,
  487. void *arg)
  488. {
  489. struct dp_mlo_mpass_buf *ptr = (struct dp_mlo_mpass_buf *)arg;
  490. struct dp_txrx_peer *txrx_peer = NULL;
  491. struct vlan_ethhdr *veh = NULL;
  492. qdf_ether_header_t *eh = (qdf_ether_header_t *)qdf_nbuf_data(ptr->nbuf);
  493. uint16_t vlan_id = 0;
  494. bool not_vlan = ((ptnr_vdev->tx_encap_type == htt_cmn_pkt_type_raw) ||
  495. (htons(eh->ether_type) != ETH_P_8021Q));
  496. if (qdf_unlikely(not_vlan))
  497. return;
  498. veh = (struct vlan_ethhdr *)eh;
  499. vlan_id = (ntohs(veh->h_vlan_TCI) & VLAN_VID_MASK);
  500. qdf_spin_lock_bh(&ptnr_vdev->mpass_peer_mutex);
  501. TAILQ_FOREACH(txrx_peer, &ptnr_vdev->mpass_peer_list,
  502. mpass_peer_list_elem) {
  503. if (vlan_id == txrx_peer->vlan_id) {
  504. qdf_spin_unlock_bh(&ptnr_vdev->mpass_peer_mutex);
  505. ptr->vlan_id = vlan_id;
  506. return;
  507. }
  508. }
  509. qdf_spin_unlock_bh(&ptnr_vdev->mpass_peer_mutex);
  510. }
  511. /**
  512. * dp_tx_mlo_mcast_multipass_send() - send multipass MLO Mcast packets
  513. * @be_vdev: Handle to DP be_vdev structure
  514. * @ptnr_vdev: DP ptnr_vdev handle
  515. * @arg: pointer to dp_mlo_mpass_ buf
  516. *
  517. * Return: None
  518. */
  519. static void
  520. dp_tx_mlo_mcast_multipass_send(struct dp_vdev_be *be_vdev,
  521. struct dp_vdev *ptnr_vdev,
  522. void *arg)
  523. {
  524. struct dp_mlo_mpass_buf *ptr = (struct dp_mlo_mpass_buf *)arg;
  525. struct dp_tx_msdu_info_s msdu_info;
  526. struct dp_vdev_be *be_ptnr_vdev = NULL;
  527. qdf_nbuf_t nbuf_clone;
  528. uint16_t group_key = 0;
  529. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  530. if (be_vdev != be_ptnr_vdev) {
  531. nbuf_clone = qdf_nbuf_clone(ptr->nbuf);
  532. if (qdf_unlikely(!nbuf_clone)) {
  533. dp_tx_debug("nbuf clone failed");
  534. return;
  535. }
  536. } else {
  537. nbuf_clone = ptr->nbuf;
  538. }
  539. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  540. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  541. msdu_info.gsn = be_vdev->seq_num;
  542. be_ptnr_vdev->seq_num = be_vdev->seq_num;
  543. if (ptr->vlan_id == MULTIPASS_WITH_VLAN_ID) {
  544. msdu_info.tid = HTT_TX_EXT_TID_INVALID;
  545. HTT_TX_MSDU_EXT2_DESC_FLAG_VALID_KEY_FLAGS_SET(
  546. msdu_info.meta_data[0], 1);
  547. } else {
  548. /* return when vlan map is not initialized */
  549. if (!ptnr_vdev->iv_vlan_map)
  550. return;
  551. group_key = ptnr_vdev->iv_vlan_map[ptr->vlan_id];
  552. /*
  553. * If group key is not installed, drop the frame.
  554. */
  555. if (!group_key)
  556. return;
  557. dp_tx_remove_vlan_tag(ptnr_vdev, nbuf_clone);
  558. dp_tx_add_groupkey_metadata(ptnr_vdev, &msdu_info, group_key);
  559. msdu_info.exception_fw = 1;
  560. }
  561. nbuf_clone = dp_tx_send_msdu_single(
  562. ptnr_vdev,
  563. nbuf_clone,
  564. &msdu_info,
  565. DP_MLO_MCAST_REINJECT_PEER_ID,
  566. NULL);
  567. if (qdf_unlikely(nbuf_clone)) {
  568. dp_info("pkt send failed");
  569. qdf_nbuf_free(nbuf_clone);
  570. return;
  571. }
  572. }
  573. /**
  574. * dp_tx_mlo_mcast_multipass_handler - If frame needs multipass processing
  575. * @soc: DP soc handle
  576. * @vdev: DP vdev handle
  577. * @nbuf: nbuf to be enqueued
  578. *
  579. * Return: true if handling is done else false
  580. */
  581. static bool
  582. dp_tx_mlo_mcast_multipass_handler(struct dp_soc *soc,
  583. struct dp_vdev *vdev,
  584. qdf_nbuf_t nbuf)
  585. {
  586. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  587. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  588. qdf_nbuf_t nbuf_copy = NULL;
  589. struct dp_mlo_mpass_buf mpass_buf;
  590. memset(&mpass_buf, 0, sizeof(struct dp_mlo_mpass_buf));
  591. mpass_buf.vlan_id = INVALID_VLAN_ID;
  592. mpass_buf.nbuf = nbuf;
  593. dp_tx_mlo_mcast_multipass_lookup(be_vdev, vdev, &mpass_buf);
  594. if (mpass_buf.vlan_id == INVALID_VLAN_ID) {
  595. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  596. dp_tx_mlo_mcast_multipass_lookup,
  597. &mpass_buf, DP_MOD_ID_TX);
  598. /*
  599. * Do not drop the frame when vlan_id doesn't match.
  600. * Send the frame as it is.
  601. */
  602. if (mpass_buf.vlan_id == INVALID_VLAN_ID)
  603. return false;
  604. }
  605. /* AP can have classic clients, special clients &
  606. * classic repeaters.
  607. * 1. Classic clients & special client:
  608. * Remove vlan header, find corresponding group key
  609. * index, fill in metaheader and enqueue multicast
  610. * frame to TCL.
  611. * 2. Classic repeater:
  612. * Pass through to classic repeater with vlan tag
  613. * intact without any group key index. Hardware
  614. * will know which key to use to send frame to
  615. * repeater.
  616. */
  617. nbuf_copy = qdf_nbuf_copy(nbuf);
  618. /*
  619. * Send multicast frame to special peers even
  620. * if pass through to classic repeater fails.
  621. */
  622. if (nbuf_copy) {
  623. struct dp_mlo_mpass_buf mpass_buf_copy = {0};
  624. mpass_buf_copy.vlan_id = MULTIPASS_WITH_VLAN_ID;
  625. mpass_buf_copy.nbuf = nbuf_copy;
  626. /* send frame on partner vdevs */
  627. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  628. dp_tx_mlo_mcast_multipass_send,
  629. &mpass_buf_copy, DP_MOD_ID_TX);
  630. /* send frame on mcast primary vdev */
  631. dp_tx_mlo_mcast_multipass_send(be_vdev, vdev, &mpass_buf_copy);
  632. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  633. be_vdev->seq_num = 0;
  634. else
  635. be_vdev->seq_num++;
  636. }
  637. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  638. dp_tx_mlo_mcast_multipass_send,
  639. &mpass_buf, DP_MOD_ID_TX);
  640. dp_tx_mlo_mcast_multipass_send(be_vdev, vdev, &mpass_buf);
  641. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  642. be_vdev->seq_num = 0;
  643. else
  644. be_vdev->seq_num++;
  645. return true;
  646. }
  647. #else
  648. static bool
  649. dp_tx_mlo_mcast_multipass_handler(struct dp_soc *soc, struct dp_vdev *vdev,
  650. qdf_nbuf_t nbuf)
  651. {
  652. return false;
  653. }
  654. #endif
  655. void
  656. dp_tx_mlo_mcast_pkt_send(struct dp_vdev_be *be_vdev,
  657. struct dp_vdev *ptnr_vdev,
  658. void *arg)
  659. {
  660. qdf_nbuf_t nbuf = (qdf_nbuf_t)arg;
  661. qdf_nbuf_t nbuf_clone;
  662. struct dp_vdev_be *be_ptnr_vdev = NULL;
  663. struct dp_tx_msdu_info_s msdu_info;
  664. be_ptnr_vdev = dp_get_be_vdev_from_dp_vdev(ptnr_vdev);
  665. if (be_vdev != be_ptnr_vdev) {
  666. nbuf_clone = qdf_nbuf_clone(nbuf);
  667. if (qdf_unlikely(!nbuf_clone)) {
  668. dp_tx_debug("nbuf clone failed");
  669. return;
  670. }
  671. } else {
  672. nbuf_clone = nbuf;
  673. }
  674. /* NAWDS clients will accepts on 4 addr format MCAST packets
  675. * This will ensure to send packets in 4 addr format to NAWDS clients.
  676. */
  677. if (qdf_unlikely(ptnr_vdev->nawds_enabled)) {
  678. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  679. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  680. dp_tx_nawds_handler(ptnr_vdev->pdev->soc, ptnr_vdev,
  681. &msdu_info, nbuf_clone, DP_INVALID_PEER);
  682. }
  683. qdf_mem_zero(&msdu_info, sizeof(msdu_info));
  684. dp_tx_get_queue(ptnr_vdev, nbuf_clone, &msdu_info.tx_queue);
  685. msdu_info.gsn = be_vdev->seq_num;
  686. be_ptnr_vdev->seq_num = be_vdev->seq_num;
  687. nbuf_clone = dp_tx_send_msdu_single(
  688. ptnr_vdev,
  689. nbuf_clone,
  690. &msdu_info,
  691. DP_MLO_MCAST_REINJECT_PEER_ID,
  692. NULL);
  693. if (qdf_unlikely(nbuf_clone)) {
  694. dp_info("pkt send failed");
  695. qdf_nbuf_free(nbuf_clone);
  696. return;
  697. }
  698. }
  699. static inline void
  700. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  701. struct dp_vdev *vdev,
  702. struct dp_tx_msdu_info_s *msdu_info)
  703. {
  704. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, msdu_info->vdev_id);
  705. }
  706. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  707. struct dp_vdev *vdev,
  708. qdf_nbuf_t nbuf)
  709. {
  710. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  711. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  712. if (qdf_unlikely(vdev->multipass_en) &&
  713. dp_tx_mlo_mcast_multipass_handler(soc, vdev, nbuf))
  714. return;
  715. /* send frame on partner vdevs */
  716. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  717. dp_tx_mlo_mcast_pkt_send,
  718. nbuf, DP_MOD_ID_REINJECT);
  719. /* send frame on mcast primary vdev */
  720. dp_tx_mlo_mcast_pkt_send(be_vdev, vdev, nbuf);
  721. if (qdf_unlikely(be_vdev->seq_num > MAX_GSN_NUM))
  722. be_vdev->seq_num = 0;
  723. else
  724. be_vdev->seq_num++;
  725. }
  726. bool dp_tx_mlo_is_mcast_primary_be(struct dp_soc *soc,
  727. struct dp_vdev *vdev)
  728. {
  729. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  730. if (be_vdev->mcast_primary)
  731. return true;
  732. return false;
  733. }
  734. #if defined(CONFIG_MLO_SINGLE_DEV)
  735. static void
  736. dp_tx_mlo_mcast_enhance_be(struct dp_vdev_be *be_vdev,
  737. struct dp_vdev *ptnr_vdev,
  738. void *arg)
  739. {
  740. struct dp_vdev *vdev = (struct dp_vdev *)be_vdev;
  741. qdf_nbuf_t nbuf = (qdf_nbuf_t)arg;
  742. if (vdev == ptnr_vdev)
  743. return;
  744. /*
  745. * Hold the reference to avoid free of nbuf in
  746. * dp_tx_mcast_enhance() in case of successful
  747. * conversion
  748. */
  749. qdf_nbuf_ref(nbuf);
  750. if (qdf_unlikely(!dp_tx_mcast_enhance(ptnr_vdev, nbuf)))
  751. return;
  752. qdf_nbuf_free(nbuf);
  753. }
  754. qdf_nbuf_t
  755. dp_tx_mlo_mcast_send_be(struct dp_soc *soc, struct dp_vdev *vdev,
  756. qdf_nbuf_t nbuf,
  757. struct cdp_tx_exception_metadata *tx_exc_metadata)
  758. {
  759. struct dp_vdev_be *be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  760. struct dp_soc_be *be_soc = dp_get_be_soc_from_dp_soc(soc);
  761. if (!tx_exc_metadata->is_mlo_mcast)
  762. return nbuf;
  763. if (!be_vdev->mcast_primary) {
  764. qdf_nbuf_free(nbuf);
  765. return NULL;
  766. }
  767. /*
  768. * In the single netdev model avoid reinjection path as mcast
  769. * packet is identified in upper layers while peer search to find
  770. * primary TQM based on dest mac addr
  771. *
  772. * New bonding interface added into the bridge so MCSD will update
  773. * snooping table and wifi driver populates the entries in appropriate
  774. * child net devices.
  775. */
  776. if (vdev->mcast_enhancement_en) {
  777. /*
  778. * As dp_tx_mcast_enhance() can consume the nbuf incase of
  779. * successful conversion hold the reference of nbuf.
  780. *
  781. * Hold the reference to tx on partner links
  782. */
  783. qdf_nbuf_ref(nbuf);
  784. if (qdf_unlikely(!dp_tx_mcast_enhance(vdev, nbuf))) {
  785. dp_mcast_mlo_iter_ptnr_vdev(be_soc, be_vdev,
  786. dp_tx_mlo_mcast_enhance_be,
  787. nbuf, DP_MOD_ID_TX);
  788. qdf_nbuf_free(nbuf);
  789. return NULL;
  790. }
  791. /* release reference taken above */
  792. qdf_nbuf_free(nbuf);
  793. }
  794. dp_tx_mlo_mcast_handler_be(soc, vdev, nbuf);
  795. return NULL;
  796. }
  797. #endif
  798. #else
  799. static inline void
  800. dp_tx_vdev_id_set_hal_tx_desc(uint32_t *hal_tx_desc_cached,
  801. struct dp_vdev *vdev,
  802. struct dp_tx_msdu_info_s *msdu_info)
  803. {
  804. hal_tx_desc_set_vdev_id(hal_tx_desc_cached, vdev->vdev_id);
  805. }
  806. #endif
  807. #if defined(WLAN_FEATURE_11BE_MLO) && !defined(WLAN_MLO_MULTI_CHIP) && \
  808. !defined(WLAN_MCAST_MLO)
  809. void dp_tx_mlo_mcast_handler_be(struct dp_soc *soc,
  810. struct dp_vdev *vdev,
  811. qdf_nbuf_t nbuf)
  812. {
  813. }
  814. bool dp_tx_mlo_is_mcast_primary_be(struct dp_soc *soc,
  815. struct dp_vdev *vdev)
  816. {
  817. return false;
  818. }
  819. #endif
  820. #ifdef CONFIG_SAWF
  821. /**
  822. * dp_sawf_config_be - Configure sawf specific fields in tcl
  823. *
  824. * @soc: DP soc handle
  825. * @hal_tx_desc_cached: tx descriptor
  826. * @fw_metadata: firmware metadata
  827. * @nbuf: skb buffer
  828. * @msdu_info: msdu info
  829. *
  830. * Return: void
  831. */
  832. void dp_sawf_config_be(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  833. uint16_t *fw_metadata, qdf_nbuf_t nbuf,
  834. struct dp_tx_msdu_info_s *msdu_info)
  835. {
  836. uint8_t q_id = 0;
  837. if (!wlan_cfg_get_sawf_config(soc->wlan_cfg_ctx))
  838. return;
  839. dp_sawf_tcl_cmd(fw_metadata, nbuf);
  840. q_id = dp_sawf_queue_id_get(nbuf);
  841. if (q_id == DP_SAWF_DEFAULT_Q_INVALID)
  842. return;
  843. msdu_info->tid = (q_id & (CDP_DATA_TID_MAX - 1));
  844. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached,
  845. (q_id & (CDP_DATA_TID_MAX - 1)));
  846. hal_tx_desc_set_flow_override_enable(hal_tx_desc_cached,
  847. DP_TX_FLOW_OVERRIDE_ENABLE);
  848. hal_tx_desc_set_flow_override(hal_tx_desc_cached,
  849. DP_TX_FLOW_OVERRIDE_GET(q_id));
  850. hal_tx_desc_set_who_classify_info_sel(hal_tx_desc_cached,
  851. DP_TX_WHO_CLFY_INF_SEL_GET(q_id));
  852. }
  853. #else
  854. static inline
  855. void dp_sawf_config_be(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  856. uint16_t *fw_metadata, qdf_nbuf_t nbuf,
  857. struct dp_tx_msdu_info_s *msdu_info)
  858. {
  859. }
  860. static inline
  861. QDF_STATUS dp_sawf_tx_enqueue_peer_stats(struct dp_soc *soc,
  862. struct dp_tx_desc_s *tx_desc)
  863. {
  864. return QDF_STATUS_SUCCESS;
  865. }
  866. static inline
  867. QDF_STATUS dp_sawf_tx_enqueue_fail_peer_stats(struct dp_soc *soc,
  868. struct dp_tx_desc_s *tx_desc)
  869. {
  870. return QDF_STATUS_SUCCESS;
  871. }
  872. #endif
  873. #ifdef WLAN_SUPPORT_PPEDS
  874. /**
  875. * dp_ppeds_stats() - Accounting fw2wbm_tx_drop drops in Tx path
  876. * @soc: Handle to DP Soc structure
  877. * @peer_id: Peer ID in the descriptor
  878. *
  879. * Return: NONE
  880. */
  881. static inline
  882. void dp_ppeds_stats(struct dp_soc *soc, uint16_t peer_id)
  883. {
  884. struct dp_vdev *vdev = NULL;
  885. struct dp_txrx_peer *txrx_peer = NULL;
  886. dp_txrx_ref_handle txrx_ref_handle = NULL;
  887. DP_STATS_INC(soc, tx.fw2wbm_tx_drop, 1);
  888. txrx_peer = dp_txrx_peer_get_ref_by_id(soc,
  889. peer_id,
  890. &txrx_ref_handle,
  891. DP_MOD_ID_TX_COMP);
  892. if (txrx_peer) {
  893. vdev = txrx_peer->vdev;
  894. DP_STATS_INC(vdev, tx_i.dropped.fw2wbm_tx_drop, 1);
  895. dp_txrx_peer_unref_delete(txrx_ref_handle, DP_MOD_ID_TX_COMP);
  896. }
  897. }
  898. int dp_ppeds_tx_comp_handler(struct dp_soc_be *be_soc, uint32_t quota)
  899. {
  900. uint32_t num_avail_for_reap = 0;
  901. void *tx_comp_hal_desc;
  902. uint8_t buf_src, status = 0;
  903. uint32_t count = 0;
  904. struct dp_tx_desc_s *tx_desc = NULL;
  905. struct dp_tx_desc_s *head_desc = NULL;
  906. struct dp_tx_desc_s *tail_desc = NULL;
  907. struct dp_soc *soc = &be_soc->soc;
  908. void *last_prefetch_hw_desc = NULL;
  909. struct dp_tx_desc_s *last_prefetch_sw_desc = NULL;
  910. qdf_nbuf_t nbuf;
  911. hal_soc_handle_t hal_soc = soc->hal_soc;
  912. hal_ring_handle_t hal_ring_hdl =
  913. be_soc->ppeds_wbm_release_ring.hal_srng;
  914. struct dp_txrx_peer *txrx_peer = NULL;
  915. uint16_t peer_id = CDP_INVALID_PEER;
  916. dp_txrx_ref_handle txrx_ref_handle = NULL;
  917. struct dp_vdev *vdev = NULL;
  918. struct dp_pdev *pdev = NULL;
  919. if (qdf_unlikely(dp_srng_access_start(NULL, soc, hal_ring_hdl))) {
  920. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  921. return 0;
  922. }
  923. num_avail_for_reap = hal_srng_dst_num_valid(hal_soc, hal_ring_hdl, 0);
  924. if (num_avail_for_reap >= quota)
  925. num_avail_for_reap = quota;
  926. dp_srng_dst_inv_cached_descs(soc, hal_ring_hdl, num_avail_for_reap);
  927. last_prefetch_hw_desc = dp_srng_dst_prefetch(hal_soc, hal_ring_hdl,
  928. num_avail_for_reap);
  929. while (qdf_likely(num_avail_for_reap--)) {
  930. tx_comp_hal_desc = dp_srng_dst_get_next(soc, hal_ring_hdl);
  931. if (qdf_unlikely(!tx_comp_hal_desc))
  932. break;
  933. buf_src = hal_tx_comp_get_buffer_source(hal_soc,
  934. tx_comp_hal_desc);
  935. if (qdf_unlikely(buf_src != HAL_TX_COMP_RELEASE_SOURCE_TQM &&
  936. buf_src != HAL_TX_COMP_RELEASE_SOURCE_FW)) {
  937. dp_err("Tx comp release_src != TQM | FW but from %d",
  938. buf_src);
  939. qdf_assert_always(0);
  940. }
  941. dp_tx_comp_get_params_from_hal_desc_be(soc, tx_comp_hal_desc,
  942. &tx_desc);
  943. if (!tx_desc) {
  944. dp_err("unable to retrieve tx_desc!");
  945. qdf_assert_always(0);
  946. continue;
  947. }
  948. if (qdf_unlikely(!(tx_desc->flags &
  949. DP_TX_DESC_FLAG_ALLOCATED) ||
  950. !(tx_desc->flags & DP_TX_DESC_FLAG_PPEDS))) {
  951. qdf_assert_always(0);
  952. continue;
  953. }
  954. tx_desc->buffer_src = buf_src;
  955. if (qdf_unlikely(buf_src == HAL_TX_COMP_RELEASE_SOURCE_FW)) {
  956. status = hal_tx_comp_get_tx_status(tx_comp_hal_desc);
  957. if (status != HTT_TX_FW2WBM_TX_STATUS_OK)
  958. dp_ppeds_stats(soc, tx_desc->peer_id);
  959. nbuf = dp_ppeds_tx_desc_free(soc, tx_desc);
  960. qdf_nbuf_free(nbuf);
  961. } else {
  962. tx_desc->tx_status =
  963. hal_tx_comp_get_tx_status(tx_comp_hal_desc);
  964. /*
  965. * Add desc sync to account for extended statistics
  966. * during Tx completion.
  967. */
  968. if (peer_id != tx_desc->peer_id) {
  969. if (txrx_peer) {
  970. dp_txrx_peer_unref_delete(txrx_ref_handle,
  971. DP_MOD_ID_TX_COMP);
  972. txrx_peer = NULL;
  973. vdev = NULL;
  974. pdev = NULL;
  975. }
  976. peer_id = tx_desc->peer_id;
  977. txrx_peer =
  978. dp_txrx_peer_get_ref_by_id(soc, peer_id,
  979. &txrx_ref_handle,
  980. DP_MOD_ID_TX_COMP);
  981. if (txrx_peer) {
  982. vdev = txrx_peer->vdev;
  983. if (!vdev)
  984. goto next_desc;
  985. pdev = vdev->pdev;
  986. if (!pdev)
  987. goto next_desc;
  988. dp_tx_desc_update_fast_comp_flag(soc,
  989. tx_desc,
  990. !pdev->enhanced_stats_en);
  991. if (pdev->enhanced_stats_en) {
  992. hal_tx_comp_desc_sync(tx_comp_hal_desc,
  993. &tx_desc->comp, 1);
  994. }
  995. }
  996. } else if (txrx_peer && vdev && pdev) {
  997. dp_tx_desc_update_fast_comp_flag(soc,
  998. tx_desc,
  999. !pdev->enhanced_stats_en);
  1000. if (pdev->enhanced_stats_en) {
  1001. hal_tx_comp_desc_sync(tx_comp_hal_desc,
  1002. &tx_desc->comp, 1);
  1003. }
  1004. }
  1005. next_desc:
  1006. if (!head_desc) {
  1007. head_desc = tx_desc;
  1008. tail_desc = tx_desc;
  1009. }
  1010. tail_desc->next = tx_desc;
  1011. tx_desc->next = NULL;
  1012. tail_desc = tx_desc;
  1013. count++;
  1014. dp_tx_prefetch_hw_sw_nbuf_desc(soc, hal_soc,
  1015. num_avail_for_reap,
  1016. hal_ring_hdl,
  1017. &last_prefetch_hw_desc,
  1018. &last_prefetch_sw_desc);
  1019. }
  1020. }
  1021. dp_srng_access_end(NULL, soc, hal_ring_hdl);
  1022. if (txrx_peer)
  1023. dp_txrx_peer_unref_delete(txrx_ref_handle,
  1024. DP_MOD_ID_TX_COMP);
  1025. if (head_desc)
  1026. dp_tx_comp_process_desc_list(soc, head_desc,
  1027. CDP_MAX_TX_COMP_PPE_RING);
  1028. return count;
  1029. }
  1030. #endif
  1031. #if defined(QCA_SUPPORT_WDS_EXTENDED)
  1032. static inline void
  1033. dp_get_peer_from_tx_exc_meta(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  1034. struct cdp_tx_exception_metadata *tx_exc_metadata,
  1035. uint16_t *ast_idx, uint16_t *ast_hash)
  1036. {
  1037. struct dp_peer *peer = NULL;
  1038. if (tx_exc_metadata->is_wds_extended) {
  1039. peer = dp_peer_get_ref_by_id(soc, tx_exc_metadata->peer_id,
  1040. DP_MOD_ID_TX);
  1041. if (peer) {
  1042. *ast_idx = peer->ast_idx;
  1043. *ast_hash = peer->ast_hash;
  1044. hal_tx_desc_set_index_lookup_override
  1045. (soc->hal_soc,
  1046. hal_tx_desc_cached,
  1047. 0x1);
  1048. dp_peer_unref_delete(peer, DP_MOD_ID_TX);
  1049. }
  1050. } else {
  1051. return;
  1052. }
  1053. }
  1054. #else
  1055. static inline void
  1056. dp_get_peer_from_tx_exc_meta(struct dp_soc *soc, uint32_t *hal_tx_desc_cached,
  1057. struct cdp_tx_exception_metadata *tx_exc_metadata,
  1058. uint16_t *ast_idx, uint16_t *ast_hash)
  1059. {
  1060. }
  1061. #endif
  1062. QDF_STATUS
  1063. dp_tx_hw_enqueue_be(struct dp_soc *soc, struct dp_vdev *vdev,
  1064. struct dp_tx_desc_s *tx_desc, uint16_t fw_metadata,
  1065. struct cdp_tx_exception_metadata *tx_exc_metadata,
  1066. struct dp_tx_msdu_info_s *msdu_info)
  1067. {
  1068. void *hal_tx_desc;
  1069. uint32_t *hal_tx_desc_cached;
  1070. int coalesce = 0;
  1071. struct dp_tx_queue *tx_q = &msdu_info->tx_queue;
  1072. uint8_t ring_id = tx_q->ring_id;
  1073. uint8_t tid;
  1074. struct dp_vdev_be *be_vdev;
  1075. uint8_t cached_desc[HAL_TX_DESC_LEN_BYTES] = { 0 };
  1076. uint8_t bm_id = dp_tx_get_rbm_id_be(soc, ring_id);
  1077. hal_ring_handle_t hal_ring_hdl = NULL;
  1078. QDF_STATUS status = QDF_STATUS_E_RESOURCES;
  1079. uint8_t num_desc_bytes = HAL_TX_DESC_LEN_BYTES;
  1080. uint16_t ast_idx = vdev->bss_ast_idx;
  1081. uint16_t ast_hash = vdev->bss_ast_hash;
  1082. be_vdev = dp_get_be_vdev_from_dp_vdev(vdev);
  1083. if (!dp_tx_is_desc_id_valid(soc, tx_desc->id)) {
  1084. dp_err_rl("Invalid tx desc id:%d", tx_desc->id);
  1085. return QDF_STATUS_E_RESOURCES;
  1086. }
  1087. if (qdf_unlikely(tx_exc_metadata)) {
  1088. qdf_assert_always((tx_exc_metadata->tx_encap_type ==
  1089. CDP_INVALID_TX_ENCAP_TYPE) ||
  1090. (tx_exc_metadata->tx_encap_type ==
  1091. vdev->tx_encap_type));
  1092. if (tx_exc_metadata->tx_encap_type == htt_cmn_pkt_type_raw)
  1093. qdf_assert_always((tx_exc_metadata->sec_type ==
  1094. CDP_INVALID_SEC_TYPE) ||
  1095. tx_exc_metadata->sec_type ==
  1096. vdev->sec_type);
  1097. dp_get_peer_from_tx_exc_meta(soc, (void *)cached_desc,
  1098. tx_exc_metadata,
  1099. &ast_idx, &ast_hash);
  1100. }
  1101. hal_tx_desc_cached = (void *)cached_desc;
  1102. if (dp_sawf_tag_valid_get(tx_desc->nbuf)) {
  1103. dp_sawf_config_be(soc, hal_tx_desc_cached,
  1104. &fw_metadata, tx_desc->nbuf, msdu_info);
  1105. dp_sawf_tx_enqueue_peer_stats(soc, tx_desc);
  1106. }
  1107. hal_tx_desc_set_buf_addr_be(soc->hal_soc, hal_tx_desc_cached,
  1108. tx_desc->dma_addr, bm_id, tx_desc->id,
  1109. (tx_desc->flags & DP_TX_DESC_FLAG_FRAG));
  1110. hal_tx_desc_set_lmac_id_be(soc->hal_soc, hal_tx_desc_cached,
  1111. vdev->lmac_id);
  1112. hal_tx_desc_set_search_index_be(soc->hal_soc, hal_tx_desc_cached,
  1113. ast_idx);
  1114. /*
  1115. * Bank_ID is used as DSCP_TABLE number in beryllium
  1116. * So there is no explicit field used for DSCP_TID_TABLE_NUM.
  1117. */
  1118. hal_tx_desc_set_cache_set_num(soc->hal_soc, hal_tx_desc_cached,
  1119. (ast_hash & 0xF));
  1120. hal_tx_desc_set_fw_metadata(hal_tx_desc_cached, fw_metadata);
  1121. hal_tx_desc_set_buf_length(hal_tx_desc_cached, tx_desc->length);
  1122. hal_tx_desc_set_buf_offset(hal_tx_desc_cached, tx_desc->pkt_offset);
  1123. if (tx_desc->flags & DP_TX_DESC_FLAG_TO_FW)
  1124. hal_tx_desc_set_to_fw(hal_tx_desc_cached, 1);
  1125. /* verify checksum offload configuration*/
  1126. if ((qdf_nbuf_get_tx_cksum(tx_desc->nbuf) ==
  1127. QDF_NBUF_TX_CKSUM_TCP_UDP) ||
  1128. qdf_nbuf_is_tso(tx_desc->nbuf)) {
  1129. hal_tx_desc_set_l3_checksum_en(hal_tx_desc_cached, 1);
  1130. hal_tx_desc_set_l4_checksum_en(hal_tx_desc_cached, 1);
  1131. }
  1132. hal_tx_desc_set_bank_id(hal_tx_desc_cached, vdev->bank_id);
  1133. dp_tx_vdev_id_set_hal_tx_desc(hal_tx_desc_cached, vdev, msdu_info);
  1134. tid = msdu_info->tid;
  1135. if (tid != HTT_TX_EXT_TID_INVALID)
  1136. hal_tx_desc_set_hlos_tid(hal_tx_desc_cached, tid);
  1137. dp_tx_set_min_rates_for_critical_frames(soc, hal_tx_desc_cached,
  1138. tx_desc->nbuf);
  1139. dp_tx_set_particular_tx_queue(soc, hal_tx_desc_cached,
  1140. tx_desc->nbuf);
  1141. dp_tx_desc_set_ktimestamp(vdev, tx_desc);
  1142. hal_ring_hdl = dp_tx_get_hal_ring_hdl(soc, ring_id);
  1143. if (qdf_unlikely(dp_tx_hal_ring_access_start(soc, hal_ring_hdl))) {
  1144. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  1145. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  1146. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  1147. dp_sawf_tx_enqueue_fail_peer_stats(soc, tx_desc);
  1148. return status;
  1149. }
  1150. hal_tx_desc = hal_srng_src_get_next(soc->hal_soc, hal_ring_hdl);
  1151. if (qdf_unlikely(!hal_tx_desc)) {
  1152. dp_verbose_debug("TCL ring full ring_id:%d", ring_id);
  1153. DP_STATS_INC(soc, tx.tcl_ring_full[ring_id], 1);
  1154. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  1155. dp_sawf_tx_enqueue_fail_peer_stats(soc, tx_desc);
  1156. goto ring_access_fail;
  1157. }
  1158. tx_desc->flags |= DP_TX_DESC_FLAG_QUEUED_TX;
  1159. dp_vdev_peer_stats_update_protocol_cnt_tx(vdev, tx_desc->nbuf);
  1160. /* Sync cached descriptor with HW */
  1161. hal_tx_desc_sync(hal_tx_desc_cached, hal_tx_desc, num_desc_bytes);
  1162. coalesce = dp_tx_attempt_coalescing(soc, vdev, tx_desc, tid,
  1163. msdu_info, ring_id);
  1164. DP_STATS_INC_PKT(vdev, tx_i.processed, 1, dp_tx_get_pkt_len(tx_desc));
  1165. DP_STATS_INC(soc, tx.tcl_enq[ring_id], 1);
  1166. dp_tx_update_stats(soc, tx_desc, ring_id);
  1167. status = QDF_STATUS_SUCCESS;
  1168. dp_tx_hw_desc_update_evt((uint8_t *)hal_tx_desc_cached,
  1169. hal_ring_hdl, soc, ring_id);
  1170. ring_access_fail:
  1171. dp_tx_ring_access_end_wrapper(soc, hal_ring_hdl, coalesce);
  1172. dp_pkt_add_timestamp(vdev, QDF_PKT_TX_DRIVER_EXIT,
  1173. qdf_get_log_timestamp(), tx_desc->nbuf);
  1174. return status;
  1175. }
  1176. #ifdef IPA_OFFLOAD
  1177. static void
  1178. dp_tx_get_ipa_bank_config(struct dp_soc_be *be_soc,
  1179. union hal_tx_bank_config *bank_config)
  1180. {
  1181. bank_config->epd = 0;
  1182. bank_config->encap_type = wlan_cfg_pkt_type(be_soc->soc.wlan_cfg_ctx);
  1183. bank_config->encrypt_type = 0;
  1184. bank_config->src_buffer_swap = 0;
  1185. bank_config->link_meta_swap = 0;
  1186. bank_config->index_lookup_enable = 0;
  1187. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_FW_EXCEPTION;
  1188. bank_config->addrx_en = 1;
  1189. bank_config->addry_en = 1;
  1190. bank_config->mesh_enable = 0;
  1191. bank_config->dscp_tid_map_id = 0;
  1192. bank_config->vdev_id_check_en = 0;
  1193. bank_config->pmac_id = 0;
  1194. }
  1195. static void dp_tx_init_ipa_bank_profile(struct dp_soc_be *be_soc)
  1196. {
  1197. union hal_tx_bank_config ipa_config = {0};
  1198. int bid;
  1199. if (!wlan_cfg_is_ipa_enabled(be_soc->soc.wlan_cfg_ctx)) {
  1200. be_soc->ipa_bank_id = DP_BE_INVALID_BANK_ID;
  1201. return;
  1202. }
  1203. dp_tx_get_ipa_bank_config(be_soc, &ipa_config);
  1204. /* Let IPA use last HOST owned bank */
  1205. bid = be_soc->num_bank_profiles - 1;
  1206. be_soc->bank_profiles[bid].is_configured = true;
  1207. be_soc->bank_profiles[bid].bank_config.val = ipa_config.val;
  1208. hal_tx_populate_bank_register(be_soc->soc.hal_soc,
  1209. &be_soc->bank_profiles[bid].bank_config,
  1210. bid);
  1211. qdf_atomic_inc(&be_soc->bank_profiles[bid].ref_count);
  1212. dp_info("IPA bank at slot %d config:0x%x", bid,
  1213. be_soc->bank_profiles[bid].bank_config.val);
  1214. be_soc->ipa_bank_id = bid;
  1215. }
  1216. #else /* !IPA_OFFLOAD */
  1217. static inline void dp_tx_init_ipa_bank_profile(struct dp_soc_be *be_soc)
  1218. {
  1219. }
  1220. #endif /* IPA_OFFLOAD */
  1221. QDF_STATUS dp_tx_init_bank_profiles(struct dp_soc_be *be_soc)
  1222. {
  1223. int i, num_tcl_banks;
  1224. num_tcl_banks = hal_tx_get_num_tcl_banks(be_soc->soc.hal_soc);
  1225. qdf_assert_always(num_tcl_banks);
  1226. be_soc->num_bank_profiles = num_tcl_banks;
  1227. be_soc->bank_profiles = qdf_mem_malloc(num_tcl_banks *
  1228. sizeof(*be_soc->bank_profiles));
  1229. if (!be_soc->bank_profiles) {
  1230. dp_err("unable to allocate memory for DP TX Profiles!");
  1231. return QDF_STATUS_E_NOMEM;
  1232. }
  1233. DP_TX_BANK_LOCK_CREATE(&be_soc->tx_bank_lock);
  1234. for (i = 0; i < num_tcl_banks; i++) {
  1235. be_soc->bank_profiles[i].is_configured = false;
  1236. qdf_atomic_init(&be_soc->bank_profiles[i].ref_count);
  1237. }
  1238. dp_info("initialized %u bank profiles", be_soc->num_bank_profiles);
  1239. dp_tx_init_ipa_bank_profile(be_soc);
  1240. return QDF_STATUS_SUCCESS;
  1241. }
  1242. void dp_tx_deinit_bank_profiles(struct dp_soc_be *be_soc)
  1243. {
  1244. qdf_mem_free(be_soc->bank_profiles);
  1245. DP_TX_BANK_LOCK_DESTROY(&be_soc->tx_bank_lock);
  1246. }
  1247. static
  1248. void dp_tx_get_vdev_bank_config(struct dp_vdev_be *be_vdev,
  1249. union hal_tx_bank_config *bank_config)
  1250. {
  1251. struct dp_vdev *vdev = &be_vdev->vdev;
  1252. bank_config->epd = 0;
  1253. bank_config->encap_type = vdev->tx_encap_type;
  1254. /* Only valid for raw frames. Needs work for RAW mode */
  1255. if (vdev->tx_encap_type == htt_cmn_pkt_type_raw) {
  1256. bank_config->encrypt_type = sec_type_map[vdev->sec_type];
  1257. } else {
  1258. bank_config->encrypt_type = 0;
  1259. }
  1260. bank_config->src_buffer_swap = 0;
  1261. bank_config->link_meta_swap = 0;
  1262. if ((vdev->search_type == HAL_TX_ADDR_INDEX_SEARCH) &&
  1263. vdev->opmode == wlan_op_mode_sta) {
  1264. bank_config->index_lookup_enable = 1;
  1265. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_MEC_NOTIFY;
  1266. bank_config->addrx_en = 0;
  1267. bank_config->addry_en = 0;
  1268. } else {
  1269. bank_config->index_lookup_enable = 0;
  1270. bank_config->mcast_pkt_ctrl = HAL_TX_MCAST_CTRL_FW_EXCEPTION;
  1271. bank_config->addrx_en =
  1272. (vdev->hal_desc_addr_search_flags &
  1273. HAL_TX_DESC_ADDRX_EN) ? 1 : 0;
  1274. bank_config->addry_en =
  1275. (vdev->hal_desc_addr_search_flags &
  1276. HAL_TX_DESC_ADDRY_EN) ? 1 : 0;
  1277. }
  1278. bank_config->mesh_enable = vdev->mesh_vdev ? 1 : 0;
  1279. bank_config->dscp_tid_map_id = vdev->dscp_tid_map_id;
  1280. /* Disabling vdev id check for now. Needs revist. */
  1281. bank_config->vdev_id_check_en = be_vdev->vdev_id_check_en;
  1282. bank_config->pmac_id = vdev->lmac_id;
  1283. }
  1284. int dp_tx_get_bank_profile(struct dp_soc_be *be_soc,
  1285. struct dp_vdev_be *be_vdev)
  1286. {
  1287. char *temp_str = "";
  1288. bool found_match = false;
  1289. int bank_id = DP_BE_INVALID_BANK_ID;
  1290. int i;
  1291. int unconfigured_slot = DP_BE_INVALID_BANK_ID;
  1292. int zero_ref_count_slot = DP_BE_INVALID_BANK_ID;
  1293. union hal_tx_bank_config vdev_config = {0};
  1294. /* convert vdev params into hal_tx_bank_config */
  1295. dp_tx_get_vdev_bank_config(be_vdev, &vdev_config);
  1296. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  1297. /* go over all banks and find a matching/unconfigured/unused bank */
  1298. for (i = 0; i < be_soc->num_bank_profiles; i++) {
  1299. if (be_soc->bank_profiles[i].is_configured &&
  1300. (be_soc->bank_profiles[i].bank_config.val ^
  1301. vdev_config.val) == 0) {
  1302. found_match = true;
  1303. break;
  1304. }
  1305. if (unconfigured_slot == DP_BE_INVALID_BANK_ID &&
  1306. !be_soc->bank_profiles[i].is_configured)
  1307. unconfigured_slot = i;
  1308. else if (zero_ref_count_slot == DP_BE_INVALID_BANK_ID &&
  1309. !qdf_atomic_read(&be_soc->bank_profiles[i].ref_count))
  1310. zero_ref_count_slot = i;
  1311. }
  1312. if (found_match) {
  1313. temp_str = "matching";
  1314. bank_id = i;
  1315. goto inc_ref_and_return;
  1316. }
  1317. if (unconfigured_slot != DP_BE_INVALID_BANK_ID) {
  1318. temp_str = "unconfigured";
  1319. bank_id = unconfigured_slot;
  1320. goto configure_and_return;
  1321. }
  1322. if (zero_ref_count_slot != DP_BE_INVALID_BANK_ID) {
  1323. temp_str = "zero_ref_count";
  1324. bank_id = zero_ref_count_slot;
  1325. }
  1326. if (bank_id == DP_BE_INVALID_BANK_ID) {
  1327. dp_alert("unable to find TX bank!");
  1328. QDF_BUG(0);
  1329. return bank_id;
  1330. }
  1331. configure_and_return:
  1332. be_soc->bank_profiles[bank_id].is_configured = true;
  1333. be_soc->bank_profiles[bank_id].bank_config.val = vdev_config.val;
  1334. hal_tx_populate_bank_register(be_soc->soc.hal_soc,
  1335. &be_soc->bank_profiles[bank_id].bank_config,
  1336. bank_id);
  1337. inc_ref_and_return:
  1338. qdf_atomic_inc(&be_soc->bank_profiles[bank_id].ref_count);
  1339. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  1340. dp_info("found %s slot at index %d, input:0x%x match:0x%x ref_count %u",
  1341. temp_str, bank_id, vdev_config.val,
  1342. be_soc->bank_profiles[bank_id].bank_config.val,
  1343. qdf_atomic_read(&be_soc->bank_profiles[bank_id].ref_count));
  1344. 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",
  1345. be_soc->bank_profiles[bank_id].bank_config.epd,
  1346. be_soc->bank_profiles[bank_id].bank_config.encap_type,
  1347. be_soc->bank_profiles[bank_id].bank_config.encrypt_type,
  1348. be_soc->bank_profiles[bank_id].bank_config.src_buffer_swap,
  1349. be_soc->bank_profiles[bank_id].bank_config.link_meta_swap,
  1350. be_soc->bank_profiles[bank_id].bank_config.addrx_en,
  1351. be_soc->bank_profiles[bank_id].bank_config.addry_en,
  1352. be_soc->bank_profiles[bank_id].bank_config.mesh_enable,
  1353. be_soc->bank_profiles[bank_id].bank_config.vdev_id_check_en,
  1354. be_soc->bank_profiles[bank_id].bank_config.pmac_id,
  1355. be_soc->bank_profiles[bank_id].bank_config.mcast_pkt_ctrl);
  1356. return bank_id;
  1357. }
  1358. void dp_tx_put_bank_profile(struct dp_soc_be *be_soc,
  1359. struct dp_vdev_be *be_vdev)
  1360. {
  1361. DP_TX_BANK_LOCK_ACQUIRE(&be_soc->tx_bank_lock);
  1362. qdf_atomic_dec(&be_soc->bank_profiles[be_vdev->bank_id].ref_count);
  1363. DP_TX_BANK_LOCK_RELEASE(&be_soc->tx_bank_lock);
  1364. }
  1365. void dp_tx_update_bank_profile(struct dp_soc_be *be_soc,
  1366. struct dp_vdev_be *be_vdev)
  1367. {
  1368. dp_tx_put_bank_profile(be_soc, be_vdev);
  1369. be_vdev->bank_id = dp_tx_get_bank_profile(be_soc, be_vdev);
  1370. be_vdev->vdev.bank_id = be_vdev->bank_id;
  1371. }
  1372. QDF_STATUS dp_tx_desc_pool_init_be(struct dp_soc *soc,
  1373. uint32_t num_elem,
  1374. uint8_t pool_id)
  1375. {
  1376. struct dp_tx_desc_pool_s *tx_desc_pool;
  1377. struct dp_hw_cookie_conversion_t *cc_ctx;
  1378. struct dp_soc_be *be_soc;
  1379. struct dp_spt_page_desc *page_desc;
  1380. struct dp_tx_desc_s *tx_desc;
  1381. uint32_t ppt_idx = 0;
  1382. uint32_t avail_entry_index = 0;
  1383. if (!num_elem) {
  1384. dp_err("desc_num 0 !!");
  1385. return QDF_STATUS_E_FAILURE;
  1386. }
  1387. be_soc = dp_get_be_soc_from_dp_soc(soc);
  1388. tx_desc_pool = &soc->tx_desc[pool_id];
  1389. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  1390. tx_desc = tx_desc_pool->freelist;
  1391. page_desc = &cc_ctx->page_desc_base[0];
  1392. while (tx_desc) {
  1393. if (avail_entry_index == 0) {
  1394. if (ppt_idx >= cc_ctx->total_page_num) {
  1395. dp_alert("insufficient secondary page tables");
  1396. qdf_assert_always(0);
  1397. }
  1398. page_desc = &cc_ctx->page_desc_base[ppt_idx++];
  1399. }
  1400. /* put each TX Desc VA to SPT pages and
  1401. * get corresponding ID
  1402. */
  1403. DP_CC_SPT_PAGE_UPDATE_VA(page_desc->page_v_addr,
  1404. avail_entry_index,
  1405. tx_desc);
  1406. tx_desc->id =
  1407. dp_cc_desc_id_generate(page_desc->ppt_index,
  1408. avail_entry_index);
  1409. tx_desc->pool_id = pool_id;
  1410. dp_tx_desc_set_magic(tx_desc, DP_TX_MAGIC_PATTERN_FREE);
  1411. tx_desc = tx_desc->next;
  1412. avail_entry_index = (avail_entry_index + 1) &
  1413. DP_CC_SPT_PAGE_MAX_ENTRIES_MASK;
  1414. }
  1415. return QDF_STATUS_SUCCESS;
  1416. }
  1417. void dp_tx_desc_pool_deinit_be(struct dp_soc *soc,
  1418. struct dp_tx_desc_pool_s *tx_desc_pool,
  1419. uint8_t pool_id)
  1420. {
  1421. struct dp_spt_page_desc *page_desc;
  1422. struct dp_soc_be *be_soc;
  1423. int i = 0;
  1424. struct dp_hw_cookie_conversion_t *cc_ctx;
  1425. be_soc = dp_get_be_soc_from_dp_soc(soc);
  1426. cc_ctx = &be_soc->tx_cc_ctx[pool_id];
  1427. for (i = 0; i < cc_ctx->total_page_num; i++) {
  1428. page_desc = &cc_ctx->page_desc_base[i];
  1429. qdf_mem_zero(page_desc->page_v_addr, qdf_page_size);
  1430. }
  1431. }
  1432. #ifdef WLAN_FEATURE_NEAR_FULL_IRQ
  1433. uint32_t dp_tx_comp_nf_handler(struct dp_intr *int_ctx, struct dp_soc *soc,
  1434. hal_ring_handle_t hal_ring_hdl, uint8_t ring_id,
  1435. uint32_t quota)
  1436. {
  1437. struct dp_srng *tx_comp_ring = &soc->tx_comp_ring[ring_id];
  1438. uint32_t work_done = 0;
  1439. if (dp_srng_get_near_full_level(soc, tx_comp_ring) <
  1440. DP_SRNG_THRESH_NEAR_FULL)
  1441. return 0;
  1442. qdf_atomic_set(&tx_comp_ring->near_full, 1);
  1443. work_done++;
  1444. return work_done;
  1445. }
  1446. #endif
  1447. #if defined(WLAN_FEATURE_11BE_MLO) && defined(WLAN_MLO_MULTI_CHIP) && \
  1448. defined(WLAN_CONFIG_TX_DELAY)
  1449. #define PPDUID_GET_HW_LINK_ID(PPDU_ID, LINK_ID_OFFSET, LINK_ID_BITS) \
  1450. (((PPDU_ID) >> (LINK_ID_OFFSET)) & ((1 << (LINK_ID_BITS)) - 1))
  1451. #define HW_TX_DELAY_MAX 0x1000000
  1452. #define TX_COMPL_SHIFT_BUFFER_TIMESTAMP_US 10
  1453. #define HW_TX_DELAY_MASK 0x1FFFFFFF
  1454. #define TX_COMPL_BUFFER_TSTAMP_US(TSTAMP) \
  1455. (((TSTAMP) << TX_COMPL_SHIFT_BUFFER_TIMESTAMP_US) & \
  1456. HW_TX_DELAY_MASK)
  1457. static inline
  1458. QDF_STATUS dp_mlo_compute_hw_delay_us(struct dp_soc *soc,
  1459. struct dp_vdev *vdev,
  1460. struct hal_tx_completion_status *ts,
  1461. uint32_t *delay_us)
  1462. {
  1463. uint32_t ppdu_id;
  1464. uint8_t link_id_offset, link_id_bits;
  1465. uint8_t hw_link_id;
  1466. uint32_t msdu_tqm_enqueue_tstamp_us, final_msdu_tqm_enqueue_tstamp_us;
  1467. uint32_t msdu_compl_tsf_tstamp_us, final_msdu_compl_tsf_tstamp_us;
  1468. uint32_t delay;
  1469. int32_t delta_tsf2, delta_tqm;
  1470. if (!ts->valid)
  1471. return QDF_STATUS_E_INVAL;
  1472. link_id_offset = soc->link_id_offset;
  1473. link_id_bits = soc->link_id_bits;
  1474. ppdu_id = ts->ppdu_id;
  1475. hw_link_id = PPDUID_GET_HW_LINK_ID(ppdu_id, link_id_offset,
  1476. link_id_bits);
  1477. msdu_tqm_enqueue_tstamp_us =
  1478. TX_COMPL_BUFFER_TSTAMP_US(ts->buffer_timestamp);
  1479. msdu_compl_tsf_tstamp_us = ts->tsf;
  1480. delta_tsf2 = dp_mlo_get_delta_tsf2_wrt_mlo_offset(soc, hw_link_id);
  1481. delta_tqm = dp_mlo_get_delta_tqm_wrt_mlo_offset(soc);
  1482. final_msdu_tqm_enqueue_tstamp_us = (msdu_tqm_enqueue_tstamp_us +
  1483. delta_tqm) & HW_TX_DELAY_MASK;
  1484. final_msdu_compl_tsf_tstamp_us = (msdu_compl_tsf_tstamp_us +
  1485. delta_tsf2) & HW_TX_DELAY_MASK;
  1486. delay = (final_msdu_compl_tsf_tstamp_us -
  1487. final_msdu_tqm_enqueue_tstamp_us) & HW_TX_DELAY_MASK;
  1488. if (delay > HW_TX_DELAY_MAX)
  1489. return QDF_STATUS_E_FAILURE;
  1490. if (delay_us)
  1491. *delay_us = delay;
  1492. return QDF_STATUS_SUCCESS;
  1493. }
  1494. #else
  1495. static inline
  1496. QDF_STATUS dp_mlo_compute_hw_delay_us(struct dp_soc *soc,
  1497. struct dp_vdev *vdev,
  1498. struct hal_tx_completion_status *ts,
  1499. uint32_t *delay_us)
  1500. {
  1501. return QDF_STATUS_SUCCESS;
  1502. }
  1503. #endif
  1504. QDF_STATUS dp_tx_compute_tx_delay_be(struct dp_soc *soc,
  1505. struct dp_vdev *vdev,
  1506. struct hal_tx_completion_status *ts,
  1507. uint32_t *delay_us)
  1508. {
  1509. return dp_mlo_compute_hw_delay_us(soc, vdev, ts, delay_us);
  1510. }
  1511. static inline
  1512. qdf_dma_addr_t dp_tx_nbuf_map_be(struct dp_vdev *vdev,
  1513. struct dp_tx_desc_s *tx_desc,
  1514. qdf_nbuf_t nbuf)
  1515. {
  1516. qdf_nbuf_dma_clean_range_no_dsb((void *)nbuf->data,
  1517. (void *)(nbuf->data + 256));
  1518. return (qdf_dma_addr_t)qdf_mem_virt_to_phys(nbuf->data);
  1519. }
  1520. static inline
  1521. void dp_tx_nbuf_unmap_be(struct dp_soc *soc,
  1522. struct dp_tx_desc_s *desc)
  1523. {
  1524. }
  1525. #ifdef QCA_DP_TX_NBUF_LIST_FREE
  1526. qdf_nbuf_t dp_tx_fast_send_be(struct cdp_soc_t *soc_hdl, uint8_t vdev_id,
  1527. qdf_nbuf_t nbuf)
  1528. {
  1529. struct dp_soc *soc = cdp_soc_t_to_dp_soc(soc_hdl);
  1530. struct dp_vdev *vdev = NULL;
  1531. struct dp_pdev *pdev = NULL;
  1532. struct dp_tx_desc_s *tx_desc;
  1533. uint16_t desc_pool_id;
  1534. uint16_t pkt_len;
  1535. qdf_dma_addr_t paddr;
  1536. QDF_STATUS status = QDF_STATUS_E_RESOURCES;
  1537. uint8_t cached_desc[HAL_TX_DESC_LEN_BYTES] = { 0 };
  1538. hal_ring_handle_t hal_ring_hdl = NULL;
  1539. uint32_t *hal_tx_desc_cached;
  1540. void *hal_tx_desc;
  1541. uint8_t desc_size = DP_TX_FAST_DESC_SIZE;
  1542. if (qdf_unlikely(vdev_id >= MAX_VDEV_CNT))
  1543. return nbuf;
  1544. vdev = soc->vdev_id_map[vdev_id];
  1545. if (qdf_unlikely(!vdev))
  1546. return nbuf;
  1547. desc_pool_id = qdf_nbuf_get_queue_mapping(nbuf) & DP_TX_QUEUE_MASK;
  1548. pkt_len = qdf_nbuf_headlen(nbuf);
  1549. DP_STATS_INC_PKT(vdev, tx_i.rcvd, 1, pkt_len);
  1550. DP_STATS_INC(vdev, tx_i.rcvd_in_fast_xmit_flow, 1);
  1551. DP_STATS_INC(vdev, tx_i.rcvd_per_core[desc_pool_id], 1);
  1552. pdev = vdev->pdev;
  1553. if (dp_tx_limit_check(vdev, nbuf))
  1554. return nbuf;
  1555. tx_desc = dp_tx_desc_alloc(soc, desc_pool_id);
  1556. if (qdf_unlikely(!tx_desc)) {
  1557. DP_STATS_INC(vdev, tx_i.dropped.desc_na.num, 1);
  1558. DP_STATS_INC(vdev, tx_i.dropped.desc_na_exc_alloc_fail.num, 1);
  1559. return nbuf;
  1560. }
  1561. dp_tx_outstanding_inc(pdev);
  1562. /* Initialize the SW tx descriptor */
  1563. tx_desc->nbuf = nbuf;
  1564. tx_desc->shinfo_addr = skb_end_pointer(nbuf);
  1565. tx_desc->frm_type = dp_tx_frm_std;
  1566. tx_desc->tx_encap_type = vdev->tx_encap_type;
  1567. tx_desc->vdev_id = vdev_id;
  1568. tx_desc->pdev = pdev;
  1569. tx_desc->pkt_offset = 0;
  1570. tx_desc->length = pkt_len;
  1571. tx_desc->flags |= DP_TX_DESC_FLAG_SIMPLE;
  1572. tx_desc->nbuf->fast_recycled = 1;
  1573. if (nbuf->is_from_recycler && nbuf->fast_xmit)
  1574. tx_desc->flags |= DP_TX_DESC_FLAG_FAST;
  1575. paddr = dp_tx_nbuf_map_be(vdev, tx_desc, nbuf);
  1576. if (!paddr) {
  1577. /* Handle failure */
  1578. dp_err("qdf_nbuf_map failed");
  1579. DP_STATS_INC(vdev, tx_i.dropped.dma_error, 1);
  1580. goto release_desc;
  1581. }
  1582. tx_desc->dma_addr = paddr;
  1583. hal_tx_desc_cached = (void *)cached_desc;
  1584. hal_tx_desc_cached[0] = (uint32_t)tx_desc->dma_addr;
  1585. hal_tx_desc_cached[1] = tx_desc->id <<
  1586. TCL_DATA_CMD_BUF_ADDR_INFO_SW_BUFFER_COOKIE_LSB;
  1587. /* bank_id */
  1588. hal_tx_desc_cached[2] = vdev->bank_id << TCL_DATA_CMD_BANK_ID_LSB;
  1589. hal_tx_desc_cached[3] = vdev->htt_tcl_metadata <<
  1590. TCL_DATA_CMD_TCL_CMD_NUMBER_LSB;
  1591. hal_tx_desc_cached[4] = tx_desc->length;
  1592. /* l3 and l4 checksum enable */
  1593. hal_tx_desc_cached[4] |= DP_TX_L3_L4_CSUM_ENABLE <<
  1594. TCL_DATA_CMD_IPV4_CHECKSUM_EN_LSB;
  1595. hal_tx_desc_cached[5] = vdev->lmac_id << TCL_DATA_CMD_PMAC_ID_LSB;
  1596. hal_tx_desc_cached[5] |= vdev->vdev_id << TCL_DATA_CMD_VDEV_ID_LSB;
  1597. if (vdev->opmode == wlan_op_mode_sta) {
  1598. hal_tx_desc_cached[6] = vdev->bss_ast_idx |
  1599. ((vdev->bss_ast_hash & 0xF) <<
  1600. TCL_DATA_CMD_CACHE_SET_NUM_LSB);
  1601. desc_size = DP_TX_FAST_DESC_SIZE + 4;
  1602. }
  1603. hal_ring_hdl = dp_tx_get_hal_ring_hdl(soc, desc_pool_id);
  1604. if (qdf_unlikely(dp_tx_hal_ring_access_start(soc, hal_ring_hdl))) {
  1605. dp_err("HAL RING Access Failed -- %pK", hal_ring_hdl);
  1606. DP_STATS_INC(soc, tx.tcl_ring_full[desc_pool_id], 1);
  1607. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  1608. goto ring_access_fail2;
  1609. }
  1610. hal_tx_desc = hal_srng_src_get_next(soc->hal_soc, hal_ring_hdl);
  1611. if (qdf_unlikely(!hal_tx_desc)) {
  1612. dp_verbose_debug("TCL ring full ring_id:%d", desc_pool_id);
  1613. DP_STATS_INC(soc, tx.tcl_ring_full[desc_pool_id], 1);
  1614. DP_STATS_INC(vdev, tx_i.dropped.enqueue_fail, 1);
  1615. goto ring_access_fail;
  1616. }
  1617. tx_desc->flags |= DP_TX_DESC_FLAG_QUEUED_TX;
  1618. /* Sync cached descriptor with HW */
  1619. qdf_mem_copy(hal_tx_desc, hal_tx_desc_cached, desc_size);
  1620. qdf_dsb();
  1621. DP_STATS_INC_PKT(vdev, tx_i.processed, 1, tx_desc->length);
  1622. DP_STATS_INC(soc, tx.tcl_enq[desc_pool_id], 1);
  1623. status = QDF_STATUS_SUCCESS;
  1624. ring_access_fail:
  1625. dp_tx_ring_access_end_wrapper(soc, hal_ring_hdl, 0);
  1626. ring_access_fail2:
  1627. if (status != QDF_STATUS_SUCCESS) {
  1628. dp_tx_nbuf_unmap_be(soc, tx_desc);
  1629. goto release_desc;
  1630. }
  1631. return NULL;
  1632. release_desc:
  1633. dp_tx_desc_release(tx_desc, desc_pool_id);
  1634. return nbuf;
  1635. }
  1636. #endif
  1637. QDF_STATUS dp_tx_desc_pool_alloc_be(struct dp_soc *soc, uint32_t num_elem,
  1638. uint8_t pool_id)
  1639. {
  1640. return QDF_STATUS_SUCCESS;
  1641. }
  1642. void dp_tx_desc_pool_free_be(struct dp_soc *soc, uint8_t pool_id)
  1643. {
  1644. }